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3.3.4  GUIDANCE  AND  CONTROL 
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3. 3. 4.1  WAYPOINT_STEERING  (PACKAGE  BODY)  TLCSC  P661  (CATALOG  #P106-0) 

This  package  contains  the  CAMP  parts  required  to  do  the  waypoint  steering 
portion  of  navigation. 

The  following  three  waypoints  are  required  to  perform  waypoint  steering:  o  A  : 
the  last  waypoint  passed  by  the  missile  o  B  :  the  waypoint  to  which  the 
missile  is  currently  heading  o  C  :  the  next  waypoint  to  which  the  missile  will 
head 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3.4. 1.1  REQUIREMENTS  ALLOCATION 

The  following  chart  summarizes  the  allocation  of  CAMP  requirements  to  this 
part: 


|  Name 

Requirements  Allocation  | 

|  Steering  Vector  Operations 

R170,  R171 

j  Steering  Vector  Operations  with  Arcsin 

N/A 

j  Compute  Turn  Angle  and  Direction 

R172 

|  Crosstrack  And  Heading  Error  Operations 

R173,  R174,  R175 

j  Distance  to  Current  Vaypoint 

R176 

j  Distance  to  Current  Vaypoint  with  Arcsin 

N/A 

j  Compute  Turning  and  Nonturning  Distances 

R177 

j  TurnTestOperations 

R178,  R179,  R180 

3. 3. 4. 1.2  LOCAL  ENTITIES  DESIGN 
None. 

3. 3. 4. 1.3  INPUT/OUTPUT 
None. 

3. 3.4. 1.4  LOCAL  DATA 
None. 

3. 3. 4. 1.5  PROCESS  CONTROL 


Not  applicable. 
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3. 3. 4. 1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

package  body  Waypoint_Steering  is 

package  body  Steering_Vector_Operations  is  separate; 

package  body  Steering_Vector_Operations_with_Arcsin  is  separate; 

procedure  Compute_Turn_Angle_and_Direction 

(Unit_Normal_C  :  in  Unit_Vectors; 

Uni t~Tangen t_B  :  in  Unit_Vectors; 

Unit~Tangent_C  :  in  Uni t_Vec tors; 

Tan_of  One_Half_Turn_Angle  :  out  Tan_Ratio; 

Turn_DlrecIion  ~  :  out  Turning_Directions) 

is  separate; 

package  body  Crosstrack_and_Heading_Error_Operations  is  separate; 

function  Distance_to  Current_Vaypoint 

(Unit_Ra3ial_M  :  Unit_Vectors; 

Unit_Tangent_B  :  Uni t~Vectors) 
return  Segment_Distances  is  separate; 

function  Distance_to  Current_Waypoint_with_Arcsin 
(Unit“Ra3ial_M  :  Unit_VectorsT 
Unit_Tangent_B  :  Uni t~Vectors) 
return  SegmentDistances  is  separate; 

procedure  Compute_Turning  and_Nonturning_Distances 

(Tan_of_One_Balf~Turn_Angle~:  in  Tan_Ratio; 

Segment  BC_Distance  :  in  Distances; 

Turn  Radius  :  in  Distances; 

Turning  Distance  :  out  Distances; 

NonturnIng_Distance  ,  :  out  Distances)  is  separate; 

package  body  Turn_Test_Operations  is  separate; 

end  Waypointsteering; 


3.3.4. 1.7  UTILIZATION  OP  OTHER  ELEMENTS 
None. 


3.3.4. 1.8  LIMITATIONS 
None. 


3.3.4. 1.9  LLCSC  DESIGN 
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3.3.4. 1.9.1  STEERING_VECTOR_OPERATIONS  (PACKAGE  BODY)  PACKAGE  DESIGN  (CATALOG 
#P107-0) 

This  package  contains  operations  to  do  the  following:  o  Initialize  the 
waypoint  steering  vectors  when  supplied  with  the  latitude  and  longitude  of  the 
past,  current,  and  next  waypoints  o  Update  the  waypoint  steering  vectors  when 
supplied  with  the  latitude  and  longitude  of  the  "new"  waypoint,  C. 

The  waypoint  steering  vectors  for  a  course  segment,  extending  from  waypoint  A 
to  waypoint  B,  are  the  segment  unit  normal  vector  (UN_B)  and  the  segment  unit 
tangent  vector  (UT_B). 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 4. 1.9. 1.1  REQUIREMENTS  ALLOCATION 

The  following  table  summarizes  the  allocation  of  CAMP  requirements  to  this 
part: 


|  Name  |  Requirements  Allocation 


|  Initialize  |  R170 
|  Update  |  R171 


3. 3. 4. 1.9. 1.2  LOCAL  ENTITIES  DESIGN 
None. 


3. 3. 4. 1.9. 1.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

The  following  generic  parameters  were  previously  defined  with  the  specification 
for  this  part. 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 
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|  Name 


Type  |  Description 


Indices 

Earth_Distanc.es 

Segment _ 
Distances 
Earth_Positions 

Sin_Cos_Ratio 

Unit  Vectors 


discrete 

type 

floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
array 


Used  to  dimension  Unit_Vectors 

Data  type  used  to  define  distance 
measurements  of  the  Earth's  radius 
Data  type  used  to  define  distance 
measurements  of  the  navigation  segments 
Data  type  used  to  define  latitude  and 
longitude  measurements 
Data  type  used  to  define  results  of  a  sine 
or  cosine  function 

Array  of  "Sin_Cos_Ratio"  dimensioned  by 
Indices 


Data  objects: 

The  following  table  describes  the  generic  formal  objects  required  by  this  part: 


|  Name 

Type 

Description 

1 

|  Earth  Radius 

EarthDistances 

Radius  of  the  Earth 

1 

Subprograms : 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 


Operator  defining  the  operation: 

Earth_Distances  *  Sin_Cos_Ratio  «>  Segment_Distances 
Operator  defining  the  operation: 

Unit_Vectors  /  Sin  Cos_Ratio  ->  Unit_Vectors 
Cross  product  function 


Name  | 

Type 

| 

function 

1 

"/"  j 

1 

function 

Cross  | 

procedure 

Product  1 

Vector 

function 

Length  j 

Sin_Cos  | 

procedure 

3. 4. 1.9.1 

.4  LOCAL 

|  Description 


I 


Calculates  the  length  of  a  vector 

Calculates  the  sine  and  cosine  of  an  input  value 


Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 
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|  Name  |  Type  j  Value  |  Description 


Unit  Radial  B 


Unit  Vectors 


N/A 


Unit  Radial  C 


Unit  Vectors 


N/A 


Unit  radial  vector  to  waypoint  B 
extending  outwards  from  the 
origin  of  the  Earth-centered 
reference  frame  towards  waypoint 
B 

Unit  radial  vector  to  waypoint  C 
extending  outwards  from  the 
origin  of  the  Earth-centered 
reference  frame  towards  waypoint 
C 


3.3.4. 1.9. 1.5  PROCESS  CONTROL 


Not  applicable. 


3. 3. 4. 1.9. 1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

with  Geometric_Operations; 

separate  (Waypoint  Steering) 

package  body  SteerTngVectorOperations  is 

package  Geo  renames  Geometric_Operations; 


- instantiate  required  parts- 


function  U_R_Vector  is  new 

Geo.Unit_Radial_Vector  (Indices  ->  Indices, 

Earth_Positions  ■>  Earth_Positions, 

Sin_Cos_Ratio  ■>  Sin_Cos_Ratio, 

Uni!_Vectors  ->  Uni t_Vec tors); 

procedure  Compute_Segment_and_U_Nl_Vector  is  new 

Geo. Compute  Segment  and  Unit  Normal  Vector 


(Indices 
Earth_Distances 
Segment_Di stances 
Sin_Cos~Ratio 
Uni!  Vectors 
EartH  Radius 


■>  Indices, 

->  Earth_Distances, 
->  Segment_Distances, 
->  Sin_Cos~Ratio, 

->  Unit  Vectors, 

->  EartH  Radius); 


—  — local  declarations- 


Unit_Radial_B  :  Unit_Vectors; 
Unit~Radial  C  :  Unit  Vectors; 
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—  — separate  procedures- 


procedure  Initialize 

(Waypoint_A_Lat 
Way po i n  t_A_Long 
Waypoint_B_Lat 
Waypoint_B_Long 
Waypoint_C_Lat 
Waypoint_C  Long 
Uni t_NormaI_B 
Unit_Normal_C 
Unit_Tangent_B 
UnitTangent  C 
Segment_BC_Dls tance 

procedure  Update 

(Vaypoint_C_Lat 
Vaypoint_C  Long 
Unit_NormaI_B 
Unit_Normal_C 
Unit_Tangent_B 
UnitTangent  C 
Segraen t_BC_Dls tance 

end  SteeringVectorOperations; 


3.3.4. 1.9. 1.7  UTILIZATION  OP  OTHER  ELEMENTS 

The  following  library  units  are  vith'd  by  this  part: 

1.  GeometricOperations  package  (Geo) 

UTILIZATION  OF  EXTERNAL  ELEMENTS: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  external  subroutines  and  task  entries 
required  by  this  part: 


in  Earth_Positions; 
in  Earth_Positions; 
in  Earth_Positions; 
in  Earth~Positions; 
in  Earth_Positions; 
in  Earth~Positions; 
out  Unit_Vectors; 
out  Unit_Vectors; 
out  Unit_Vectors; 
out  Unit_Vectors; 

out  Segment_Distances)  is  separate; 


:  in  Earth_Positions; 

:  in  Earth_Positions; 

:  out  Unit_Vectors; 

:  in  out  Unit_Vectors; 

:  out  Unit_Vectors; 

:  in  out  Unit~Vectors; 

:  out  Segment_Distances)  is  separate; 


|  Name 

1  Type 

|  Source  | 

|  Description  | 

Unit_Radial_Vector 

|  generic 
function 

|  Geo 

Computes  a  unit  radial  vector 

Compute  Segment  and 

j  generic 

j  Geo 

Computes  segment  distance 

Uni t_Normal_Vec  tor 

function 

1 

and  unit  normal  vectir 

3.3.4. 1.9. 1.8  LIMITATIONS 


None. 
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3.3.4. 1.9. 1.9  LLCSC  DESIGN 


None. 


3.3.4.1.9.1.10  UNIT  DESIGN 

3.3.4.1.9.1.10.1  INITIALIZE  (PROCEDURE  BODY)  UNIT  DESIGN 

This  part  initializes  the  waypoint  steering  vectors  when  supplied  with  the 
latitude  and  longitude  of  the  past  (A),  present  (B),  and  next  (C)  waypoints. 

This  part  initializes  the  waypoint  steering  vectors  for  the  "current"  course 
segment  AB,  as  well  as  for  the  "next"  course  segment  BC. 


3.3.4.1.9.1.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R170. 


3.3.4.1.9.1.10.1.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.1.9.1.10.1.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

Type 

Mode 

Description  | 

|  Vaypoint_A_Lat, 

I  Vaypoint  A  Long 

Earth_Positions 

in 

Latitude  and  longitude  of 
the  "previous"  waypoint 

j  Vaypoint_B  Lat, 
j  Vaypoint  S  Long 

Earth_Positions 

in 

Latitude  and  longitude  of 
the  "current"  waypoint 

j  Vaypoint_C_Eat , 

I  VaypoinT  C  Long 

Ear th_Posit ions 

in 

Latitude  and  longitude  of 
the  "next"  waypoint 

j  Unit_Normal  B, 

Unit  Normal  C 

Uni t_Vec tors 

out 

Unit  normal  vectors  for 
segments  AB  and  BC 

j  Unit_Tangent_B, 
Unit  Tangen"t  C 

Unit_Vectors 

out 

Unit  tangent  vectors  for 
segments  AB  and  BC 

j  Segment_BC_ 
j  Distance 

Segment_ 

Distances 

out 

Great  circle  ardength 
between  waypoints  B  and  C 

3.3.4.1.9.1.10.1.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 
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1 

Name 

1 

Type 

|  Value 

|  Description 

1 

1 

Temp  UN  B 

1 

Unit  Vectors 

|  N/A 

|  Temporary  Unit  Normal  B  vector 

1 

1 

Temp  UN  C 

Unit  Vectors 

|  N/A 

j  Temporary  Unit  Normal  C  vector 

1 

Unit  Racial  A 

1 

Unit  Vectors 

j  N/A 

j  Unit  radial  vector  pointing  to 

1 

1 

)  waypoint  A 

1 

V  Length 

1 

Sin_Cos_Ratio 

j  N/A 

j  Vector  length 

1 

3.3.4.1.9.1.10.1.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.1.9.1.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Waypoint_Steering.  Steering_Vector_Operations) 
procedure  Initialize 

(Waypoint_A_Lat 
Way po i n  t_A_Long 
Waypoint  J5_Lat 
Way po i n  tBLong 
VaypointCLat 
Vaypoint_C  Long 
Uni  t_NormaI_B 
Uni  t_Normal_C 
Unit_Tangent_B 
Unit_Tangent  C 
Segmen t_BC_Dls  t ance 


—  —declaration  section- 


Temp_UN_B  :  Uni t_Vec tors; 
Temp_UN~C  :  Uni t_Vec tors; 
Unit_RaJial_A  :  Unit  Vectors; 
V_Length  ~  :  Sin_Cos  Ratio; 


— begin  procedure  Initialize- 


begin 

—  — compute  unit  radial  vectors 

Unit_Radial_A  U_R_Vector(Lat_of  Point  -> 

Long_oT_Point  -> 
Unit_Radial_B  : -  U_R_Vector(Lat_of  Point  -> 

Long_oI_Point  -> 
Unit_Radial_C  : »  U_R_Vector(Lat_of  Point  »> 

Long_oI_Point  -> 


Waypoint_A_Lat, 
Waypoint~A_Long) ; 
Waypoint_B~Lat, 
Waypoint_B~Long) ; 
Waypoint_C~Lat, 
Waypoint_C~Long) ; 


in  Earth_Positions; 
in  Ear th_Posit ions; 
in  Earth_Positions; 
in  EarthPositions; 
in  Earth_Positions; 
in  Earth  Positions; 
out  Unit_Vectors; 
out  Uni t_Vec tors; 
out  Uni t~Vec tors; 
out  UnitVectors; 
out  Segmen t_Di stances)  is 


CAMP  Software  Detailed  Design  Document 


Page  431 


—  — compute  UN_B 

Temp_UN_B 

V_Length 

Temp_UN_B 

Unit~Normal_B 

—  — compute  UTJB 
Unit_Tangent_B 


Cross_Product(Lef t  =>  Unit_Radial_B, 
Right  *>  Unit_Radial~A) ; 
Vector_Length(Temp_UN_B) ; 

Terap_UN_B  /  V_Length; 

Temp~UN_B; 


Cross_Product(Lef t  »>  Temp_UN  B, 

Right  ■>  Unit_Ra3ial  B); 


—  — compute  UN_C  and  segment  BC  distance 


Compute_Segment  and_U_Nl_Vector 

(Unit_RadialT  *>  Unit_Radial_B, 

Unit_Radial2  »>  Unit_Radial_C, 

Unit_Normal2  ->  Temp_UN_C, 

Segment_Di stance  ->  Segment_BC_Distance) ; 

Unit_Normal_C  :  -  Temp  UN  C; 

—  — compute  UT_C 

UnitTangentC  :■  Cross_Product(Lef t  •>  Temp_UN  C, 

Right  »>  Unit_Ra3ial_C) ; 

end  Initialize; 


3.3.4.1.9.1.10.1.7  UTILIZATION  OP  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  instantiated  in  the  body  of  the  Steering_Vector_Operations 
package: 


|  Name 

Type 

|  Description  | 

|  U_R_Vector 
|  Compute  Segment  and 
j  U_Nl_Vector 

!  function 
function 

|  Computes  a  unit  radial  vector  j 

|  Computes  segment  distance  and  unit  ! 

|  normal  vector  I 

The  following  table  describes  the  subroutines  required  by  this  pr*rt  and  defined 
as  generic  formal  subroutines  to  the  Steering_Vector_Operations  package: 
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|  Name  |  Type  |  Description 


II  /  If 


function 


Cross_  |  procedure 
Product  I 

Vector  |  function 
Length  j 


Operator  defining  the  operation: 

Unit_Vectors  /  Sin  Cos_Ratio  =>  Unit_Vectors 
Cross-product  function 

Calculates  the  length  of  a  vector 


Data  types: 

The  following  data  types  are  required  by  this  part  and  defined  as  generic 
parameters  to  the  Steering_Vector_Operations  package: 


1 

Name 

Type 

Description  | 

1 

Indices 

discrete 

Used  to  dimension  Unit  Vectors 

type 

1 

Earth  Distances 

floating 

Data  type  used  to  define  distance 

1 

point  type 

measurements  of  the  Earth's  radius 

1 

Segment 

floating 

Data  type  used  to  define  distance 

1 

Distances 

point  type 

measurements  of  the  navigation  segments 

Earth  Positions 

floating 

Data  type  used  to  define  latitude  and 

point  type 

longitude  measurements 

1 

Sin  Cos  Ratio 

floating 

Data  type  used  to  define  results  of  a  sine 

1 

• 

point  type 

or  cosine  function 

! 

Unit  Vectors 

array 

Array  of  "Sin  Cos  Ratio"  dimensioned  by 

1 

Indices  ~  ~ 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  Steering_Vector_Operations: 


|  Name  |  Type 


Value  |  Description 


Unit  Radial  B 


Unit  Vectors 


N/A 


Unit  Radial  C 


Unit  Vectors 


N/A 


Unit  radial  vector  to  vaypoint  B 
extending  outwards  from  the 
origin  of  the  Earth-centered 
reference  frame  towards  waypoint 
B 

Unit  radial  vector  to  waypoint  C 
extending  outwards  from  the 
origin  of  the  Earth-centered 
reference  frame  towards  waypoint 

C 
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3.3.4.1.9.1.10.1.8  LIMITATIONS 


None. 


3.3.4.1.9.1.10.2  UPDATE  (PROCEDURE  BODY)  UNIT  DESIGN 

This  part  updates  the  waypoint  steering  vectors  when  supplied  with  the  latitude 
and  longitude  of  the  "new"  waypoint,  C. 

The  waypoint  steering  vectors  for  a  course  segment,  extending  from  waypoint  A 
to  waypoint  B,  are  the  segment  unit  normal  vector  (UN_B)  and  the  segment  unit 
tangent  vector  (UT_B). 


3.3.4.1.9.1.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R171. 


3.3.4.1.9.1.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.1.9.1.10.2.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

Type 

|  Mode 

Description  | 

Vaypoint  C  Lat, 

Earth  Positions 

in 

Latitude  and  longitude  of 

Waypoint  C  Long 

the  "next"  waypoint 

Unit  Normal  B, 

Unit  Vectors 

out 

Unit  normal  vectors  for 

Unit  Normal  C 

in  out 

segments  AB  and  BC 

Unit  Tangent  B, 

Unit  Vectors 

out 

Unit  tangent  vectors  for 

!  Unit  Tangent  C 

in  out 

segments  AB  and  BC 

j  Segment  BC 

Segment 

out 

Great  circle  arclength 

|  Distance 

Distances 

between  waypoints  B  and  C 

3.3.4.1.9.1.10.2.4  LOCAL  DATA 


None. 


3.3.4.1.9.1.10.2.5  PROCESS  CONTROL 


Not  applicable. 
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3.3.4.1.9.1.10.2.6  PROCESSING 


The  following  describes  the  processing  performed  by  this  part: 

separate  (Vaypoint_Steering. Steering_Vector_Operations) 
procedure  Update 

(Waypoint_C_Lat 


begin 


Vaypoint_C  Long 
Unit_NormaT_B 
Unit~Normal_C 
Unit_Tangent_B 
UnitJTangent  C 
Segment  BC  Distance 


in  Earth  Positions; 

in  Earth~Positions; 

out  Unit_Vectors; 
in  out  Unit_Vectors; 

out  Unit_Vectors; 
in  out  Unit_Vectors; 

out  Segment  Distances)  is 


— advance  "C"  vectors  into  "B"  vectors 


UnitRadialB  :-  UnitRadialC; 

Uni  t_Normal~B  :  -  Uni  t_Normal~C; 

Unit_Tangent_B  : »  Unit_Tangent_C; 

—  — calculate  new  values 

Unit  Radial  C  :■  U_R_Vector(Lat_of  Point  ->  Waypoint_C_Lat , 

Long_oI_Point  ->  Vaypoint_C_Long) ; 

ComputeSegment  andUNl  Vector 

(Unit  RadialT  ->  Unit  Radial  B, 

Unit ~Radial2  ->  Unit  Rad ial_C, 

Unit_Normal2  ■>  Unit_Noraal-C, 

Segment _Di stance  ->  Segn«nt_BC_Di stance); 

Unit_Tangent_C  s-  Cross_Product(Lef t  ->  Unit_Normal_C, 

Right  ->  Unit_Radial_C) ; 


end  Update; 


3.3.4.1.9.1.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  instantiated  in  the  body  of  the  Steering_Vector_Operations 
package : 
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|  Name 


Type  |  Description 


|  UR  Vector  |  function  |  Computes  a  unit  radial  vector 

j  Compute_Segment_and  _  j  function  j  Computes  segment  distance  and  unit 

j  U_Nl_Vector  j  j  normal  vector 


The  following  table  describes  the  subroutines  required  by  this  part  and  defined 
as  generic  formal  subroutines  to  the  Steering_Vector_Operations  package: 


|  Name  | 

Type 

Description  | 

|  Cross_  | 
j  Product  j 

procedure 

Cross  product  function  | 

1 

Data  types: 

The  following  data  types  are  required  by  this  part  and  defined  as  generic 
parameters  to  the  Steering_Vector_Operations  package: 


1 

Name 

Type 

Description  | 

1 

Indices 

discrete 

Used  t-o  dimension  Unit  Vectors 

1 

type 

Earth  Distances 

floating 

Data  type  used  to  define  distance 

point  type 

measurements  of  the  Earth's  radius 

1 

Segment 

floating 

Data  type  used  to  define  distance 

1 

Distances 

point  type 

measurements  of  the  navigation  segments 

1 

Earth  Positions 

floating 

Data  type  used  to  define  latitude  and 

1 

point  type 

longitude  measurements 

1 

Sin  Cos  Ratio 

floating 

Data  type  used  to  define  results  of  a  sine 

1 

point  type 

or  cosine  function 

1 

Unit  Vectors 

array 

Array  of  "Sin  Cos  Ratio"  dimensioned  by 

1 

Indices 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  Steering_Vector_Operations: 
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|  Name  |  Type  |  Value  |  Description 


Unit  Radial  B 


Unit  Vectors 


N/A 


Unit  Radial  C 


Unit  Vectors 


N/A 


Unit  radial  vector  to  waypoint  B 
extending  outwards  from  the 
origin  of  the  Earth-centered 
reference  frame  towards  waypoint 
B 

Unit  radial  vector  to  waypoint  C 
extending  outwards  from  the 
origin  of  the  Earth-centered 
reference  frame  towards  waypoint 
C 


3.3.4.1.9.1.10.2.8  LIMITATIONS 
None. 


3. 3. 4. 1.9. 2  CROSSTRACK_AND_HEADING_ERROR_OPERATIONS  (PACKAGE  BODY)  PACKAGE  DESIGN 
(CATALOG  #P109-0) 

This  part  contains  the  routines  require  to  compute  the  crosstrack  and  heading 
errors  for  a  missile  in  turning  or  nonturning  flight. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 4. 1.9. 2.1  REQUIREMENTS  ALLOCATION 

The  following  table  summarizes  the  allocation  of  CAMP  requirements  to  this 
part: 


|  Name 

|  Requirements  Allocation 

1 

Compute  When  Turning 

R173 

1 

Compute  When  Not  Turning 

R175 

Compute 

R174 

1 

3. 3. 4. 1.9. 2. 2  LOCAL  ENTITIES  DESIGN 


None. 


3. 3. 4. 1.9. 2. 3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

The  following  generic  parameters  were  defined  when  this  part  was  originally 
specified: 
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Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name 

Type 

Description  | 

|  Navigation  Indices 

discrete 

Data  type  used  to  dimension  Velocity 

1 

type 

Vectors 

|  Unit  Indices 

discrete 

type 

Data  type  used  to  dimension  Unit  Vectors 

j  Angles 

1 

floating 
point  type 

Data  type  of  angular  measurements 

|  Earth  Distances 

floating 

Data  type  used  to  define  distance 

point  type 

measurements  of  the  Earth's  radius 

j  Segment 

floating 

Data  type  used  to  define  distance 

I  Distances 

point  type 

measurements  of  the  navigation  segments 

j  Sin  Cos  Ratio 

floating 

Data  type  of  results  of  sine/cosine 

point  type 

operations 

j  Tan  Ratio 

floating 
point  type 

Data  type  of  tangent  operations 

|  Velocities 

1 

floating 
point  type 

Data  type  of  velocity  measurements 

|  Unit_Vectors 

array 

Array,  dimensioned  by  Unit_Indices,  of 
Sin  Cos  Ratio 

j  VelocityVectors 

array 

Array,  dimensioned  by  Navigation_ 

Indices,  of  Velocities 

Data  objects: 

The  following  table  describes  the  generic  formal  objects  required  by  this  part: 


Name 


I  Type 


|  Value 


Description 


|  E(ast) 

1 

Navigation_  |  'FIRST 
Indices 

1 

Used  to  access  first  element  of 
arrays  dimensioned  by  Navigation_ 
Indices 

j  N(orth) 

1 

1 

Navigation_  |  'SUCC(E) 
Indices  1 

1 

Used  to  access  second  element  of 
arrays  dimensioned  by  Navigation_ 
Indices 

1  U(p) 

1 

1 

Navigation_  j  'LAST 
Indices 

1 

Used  to  access  last  element  of 
arrays  dimensioned  by  Navigation_ 
Indices 

j  X 

1 

1 

Unit_Indices  |  'FIRST 
Indices  1 

1 

Used  to  access  first  element  of 
arrays  dimensioned  by  Unit_ 

Indices 

I  Y 

1 

1 

Unit_Indices  |  'SUCC(X) 
Indices 

1 

Used  to  access  second  element  of 
arrays  dimensioned  by  Unit_ 

Indices 

j  Z 

1 

Unit_Indices  j  'LAST 
Indices  j 

1 

Used  to  access  last  element  of 
arrays  dimensioned  by  Unit_ 

Indices 

j  Earth  Radius 

Earth  j  n/a 

Radius  of  the  Earth 

Distances  \ 
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Subprograms: 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part : 


|  Name 

Type 

Description  | 

|  '«*" 

function 

Multiplication  operator  defining  the  operation: 
Sin_Cos_Ratio  *  Earth_Distances  ■> 

Segmen t  Di s  tances 

I 

1 

function 

Multiplication  operator  defining  the  operation: 
Sin_Cos_Ratio  *  Segment_Dis tances  *> 

Segment  Distances 

1 

function 

Multiplication  operator  defining  the  operation: 
Segment  Distances  *  INTEGER  ■>  Segment  Distances 

"*« 

1 

function 

Multiplication  operator  defining  the  operation: 
INTEGER  *  Sin  Cos  Ratio  ->  Sin  Cos  Ratio 

«*" 

function 

Multiplication  operator  defining  the  operation: 
Segment  Distances  *  Velocities  ->  Tan  Ratio 

1 

function 

Multiplication  operator  defining  the  operation: 

Sin  Cos  Ratio  *  Velocities  «>  Velocities 

j  "/" 

1 

function 

Division~operator  defining  the  operation: 

Velocities  /  Velocities  ->  Tan  Ratio 

|  Dot_ 
j  Product 

function 

Dot  product  function 

1  Sqrt 

function 

Square  root  function 

|  Arc tan 

function 

Arctangent  function 

3.3.4. 1.9. 2. 4  LOCAL  DATA 


None. 


3. 3. 4. 1.9. 2. 5  PROCESS  CONTROL 
Not  applicable. 


3. 3. 4. 1.9. 2. 6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
separate  (Waypoint_Steering) 

package  body  Crosstrack_and_Heading_Error_Operations  is 
procedure  Compute_When_Turning 


(Distance_to_B 

in 

Segment_Distances; 

Nonturning  Distance 

in 

Segmen t_Dis tances ; 

Uni t_RadiaI_M 

in 

Uni t_Vec tors; 

Unit_Normal~B 

in 

Uni t~Vec tors; 

Unit~Tangent_B 

in 

Unit  Vectors; 

Turn_Direction 

in 

TurnTng_Directions ; 

Ground_Velocity 

in 

Velocity_Vectors; 

Turn_Radius 

in 

Segment  Distances ; 
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:$■ 


Cross track_Error  :  out  Segment_Distances; 

Heading_Error  :  out  Angles)-is  separate; 


procedure  Compute_When  Not  Turning 


(Unit_RadTal_M 
Unit  Normal^B 
Grouiid_Velocity 
Crosstrack_Error 
Heading  Error 


in  Unit_Vectors; 
in  Unit_Vectors; 
in  Velocity_Vectors; 
out  Segment_Distances; 
out  Angles)~is  separate; 


procedure  Compute 

(Distance_to_B 
Nonturning  Distance 
Unit_RadiaI_M 
Uni t_Normal_B 
Unit_Tangent_B 
Turn_Direction 
TurnStatus 
Ground_Velocity 
Turn_Radius 
Crosstrack_Error 
Heading_Error 


in  Segment_Distances; 
in  Segment~Distances; 
in  Unit_Vectors; 
in  Unit_Vectors; 
in  Unit  Vectors; 
in  TurnIng_Directions; 
in  Turning~Statuses; 
in  Velocity_Vectors; 
in  Segment_Distances; 
out  Segment_Distances; 
out  Angles)  is  separate; 


end  Cross track_and_Heading_Error_Operations; 


3. 3. 4. 1.9. 2. 7  UTILIZATION  OP  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsevhere  in  the  parent  top  level  component: 

Data  types: 

The  following  table  describes  the  data  types  required  by  this  part  and  defined 
in  the  package  specification  of  Vaypoint_Steering: 


|  Name 

|  Range  | 

|  Turning  Directions 

|  Left  Turn,  1 

j  RigKt_Turn  | 

j  Turning  Statuses 

1  1 

|  Turning,  j 

Not_Turning  | 

Description 


Indicates  if  the  missile  needs  to  make 
a  right  or  a  left-hand  turn  to  go  to 
the  next  waypoint 

Indicates  whether  or  not  the  missile  is 
currently  turning 


3. 3. 4. 1.9. 2. 8  LIMITATIONS 


None. 
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3. 3. 4. 1.9. 2. 9  LLCSC  DESIGN 


None. 


3.3.4.1.9.2.10  UNIT  DESIGN 

3.3.4.1.9.2.10.1  COMPUTE_WHEN_TURNING  (PROCEDURE  BODY)  UNIT  DESIGN 

This  part  computes  the  crosstrack  and  heading  error  for  a  missile  in  turning 
flight. 

NOTE:  By  the  time  this  part  is  called  the  waypoints  have  been  updated  so  that 
the  missile  is  now  turning  past  waypoint  A  to  go  on  to  waypoint  B. 


3.3.4.1.9.2.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R173. 


3.3.4.1.9.2.10.1.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.4.1.9.2.10.1.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 
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|  Name 

Type 

|  Distance 

Segment 

|  to  B 

Distances 

|  Nonlurning 

Segment 

j  Distance 

Distancv 

|  Unit 

Unit  Vectors 

j  RadTal_M 

1 

j  Unit 

Unit  Vectors 

j  Normal  B 

j  Unit 

Unit  Vectors 

Tangent  B 

j  Turn 

Turning 

j  Direction 

Directions 

j  Ground 

Velocity 

j  Velocity 

Vectors 

j  Turn  Radius 

Segment 

Distances 

j  Cross track 

Segment 

j  Error 

1 

Distances 

1 

|  Heading 

Angles 

j  Error 

1 

Mode 

in 

in 

in 

in 

in 

in 

in 

in 

out 

out 


j  Description 


I 


Distance  from  missile  position  to 
the  current  waypoint,  B 
Distance  from  point  of  tangency  of 
turn  circle  and  next  course  segment, 
BC,  to  next  waypoint,  C 
Unit  radial  vector  to  the  missile 
extending  outward  from  the  origin 
of  the  Earth-centered  reference 
frame 

Segment  AB  unit  normal  vector 

Segment  AB  unit  tangent  vector 

Direction  of  turn  required  to  go 
from  waypoint  B  to  waypoint  C 
Missile  ground  velocity  with  N  and  E 
components 

Desired  missile  turn  radius 

Missile  displacement  normal  to  the 
commanded  ground  track;  is  positive 
when  missile  is  to  the  right  as 
vieved  in  the  direction  of  flight 
Difference  between  the  current 
missile  heading  and  the  desired 
heading 


3.3.4.1.9.2.10.1.4  LOCAL  DATA 


Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 
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|  Name  | 

Type  | 

Description  | 

|  Cross track_  j 
Distance 

Segmen t_  | 

Distances  j 

Distance  of  missile  from  line  segment  AB 

|  D  Y  | 

Segment 

Difference  between  turning  radius  and 

Distances 

crosstrack  distance 

j  D  X 

Segment  j 

Difference  Between  distance  to  B  and 

Distances  i 

nonturning  distance 

1  D_H_D_C 

Segmen t_  S 

Distances 

Used  for  intermediate  calculations 

|  Direction  j 

INTEGER 

+1  if  missile  is  making  a  right  turn, 

1  1 

1 

-1  if  missile  is  making  a  left  turn 

|  Dot  Prod  | 

Sin  Cos  Ratio 

Dot  product  result,  which,  due  to  the 
geometry,  equals  the  angle  between  the 

I  Result 

1  1 

1 

desired  UR  M  and  the  actual  UR  M 

j  N_H_D_C  | 

Segmen t_ 
Distances 

Used  for  intermediate  calculations 

|  R  M 

Segment  j 

Turning  radius  actually  being  flown  by 

Distances 

the  missile 

3.3.4.1.9.2.10. 

1.5  PROCESS  CONTROL 

Not  applicable. 

3.3.4.1.9.2.10. 

1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 


separate  (Vaypoint_Steering. Cross track_and_Heading_Error_Operations) 
procedure  Compute_When_Turning 
(Distance_to_B 
Nonturning  Distance 
Uni t_RadiaI_M 
Uni t_Normal_B 
Uni tTangen t_B 
Turn_Direction 
Ground_Veloci ty 
Turn_Radius 
Cross track_Error 
Heading  Error 


in 

Segmen  t_Di s tances ; 

in 

Segmen  t_Dis  tances ; 

in 

Uni t_Vec tors; 

in 

Uni t_Vec tors; 

in 

Uni t~Vec tors; 

in 

TurnIng_Di r ec  t i ons ; 

in 

Velocity  Vectors; 

in 

Segmen t_5i stances; 

out 

Segmen t~Di stances; 

out 

Angles)  is 

—  — declaration  section 


Cross  t  rack_Di s  tance 

D_Y 

D_X 

D  H_D_C 
Direction 
Dot_Prod_Result 
N_H_D  C 
RH 


Segmen  t_Dis  tances ; 
Segmen  t_Dis  tances ; 
Segmen t~Di stances; 
Segmen t^Dis  tances ; 
INTEGER; 
Sin_Cos_Ratio; 
Segmen t_Di stances; 
Segmen  t_Distances; 
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— begin  procedure  Compute_When_Turning- 


begin 

—  — convert  turn  direction  to  an  integer  value 

if  Turn_Di recti on  -  Left_Turn  then 
Direction  :■  -1; 
else 

Direction  :■  1; 
end  if; 

- get  the  sine  of  the  angle  (which  approximately  equals  the  angle) 

—  — between  the  actual  and  desired  UR_M, 

—  — and  then  compute  crosstrack  distance 

Dot_Prod_Result  :«  Dot_Product  (Left  ->  Unit_Radial_M, 

Right  ->  Unit  NormalB); 

Crosstrack  Distance  Dot_Prod_Result  *  Earth_Ra3ius; 

- compute  the  radius  of  the  circle  that  the  missile  is  actually  traversing 

D_Y  Turn_Radius  -  Cross trackJDistance  *  Direction; 

D_X  :«  Distanceto  B  -  Nonturning  Distance; 

R_M  :«  Sqrt(D_X  *  5_X  +  D_Y  *  D  Yj; 

- compute  cross track  error 

CrosstrackError  s-  (Turn_Radius  -  R_M)  *  Direction; 

- compute  heading  error 

N_H_D_C  : -  Direction  *  Unit_Tangent_B(Z)  *  D_X  - 
Unit_Normal_B(Z)~*  D_Y; 

D_H_D_C  :■  -Direction  *  Unit_Normal_B(Z)  *  D  X  - 
Uni t_Tangent_B(Z)  *  D_Y; 

Heading_Error  s-  Arctan((N_H_D_C  *  Ground_Velocity(N)  - 

DTDlC  *  Ground~Velocity(E))  / 

(D”H”D”C  *  Ground_Veloci ty(N)  + 

N  H  D-C  *  Ground  Velocity(E))); 


end  Compute_When_Turning; 


3.3.4.1.9.2.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 
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Subprograms  and  task  entries: 

The  following  subprograms  are  required  by  this  part  and  defined  as  generic 
formal  parameters  to  the  Crosstrack_and_Heading_Error_Operations  package: 


|  Name 

1  Type 

Description 

|  «*" 

|  function 

1 

1 

Multiplication  operator  defining  the  operation: 
Sin_Cos_Ratio  *  Earth_Distances  *> 

Segment  Distances 

|  function 

1 

Multiplication  operator  defining  the  operation: 
Sin  Cos  Ratio  *  Segment  Distances  -> 

Segment  Distances 

|  function 

1 

Multiplication  operator  defining  the  operation: 
Segment  Distances  *  INTEGER  ■>  Segment  Distances 

|  function 

1 

Multiplication  operator  defining  the  operation: 
INTEGER  *  Sin  Cos  Ratio  ■>  Sin  Cos  Ratio 

j  function 

1 

Multiplication~operator  defining  the  operation: 
Segment  Distances  *  Velocities  ->  Tan  Ratio 

| 

|  function 

I 

Multiplication  operator  defining  the  operation: 
Sin  Cos  Ratio  *  Velocities  ->  Velocities 

1 

j  function 

Division  operator  defining  the  operation: 
Velocities  /  Velocities  ->  Tan  Ratio 

1  Dot_ 
j  Product 

j  function 

Dot  product  function 

1  Sqrt 

j  function 

Square  root  function 

j  Arctan 

j  function 

Arctangent  function 

Data  types: 

The  following  data  types  are  required  by  this  part  and  defined  as  generic 
formal  parameters  to  the  Cross track_and_Heading_Error_Operat ions  package: 
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|  Name 

Type 

Description  | 

|  Navigation  Indices 

discrete 

Data  type  used  to  dimension  Velocity 

type 

Vectors 

j  Unit  Indices 

discrete 

Data  type  used  to  dimension  Unit  Vectors 

type 

j  Angles 

floating 
point  type 

Data  type  of  angular  measurements 

•  Earth  Distances 

floating 

Data  type  used  to  define  distance 

point  type 

measurements  of  the  Earth's  radius 

j  Segment 

floating 

Data  type  used  to  define  distance 

j  Distances 

point  type 

measurements  of  the  navigation  segments 

j  Sin  Cos  Ratio 

floating 

Data  type  of  results  of  sine/cosine 

point  type 

operations 

j  Tan_Ratio 

floating 
point  type 

Data  type  of  tangent  operations 

|  Velocities 

floating 
point  type 

Data  type  of  velocity  measurements 

|  Unit  Vectors 

array 

Array,  dimensioned  by  Unit  Indices,  of 

Sin  Cos  Ratio 

j  Velocity  Vectors 

1 

array 

Array,  dimensioned  by  Navigation_ 

Indices,  of  Velocities 

The  following  table  describes  the  data  types  required  by  this  part  and  defined 
in  the  package  specification  of  WaypointSteering: 


|  Name 

Range 

Description  | 

Turning  Directions 

Left  Turn, 

Indicates  if  the  missile  needs  to  make 

RigKt  Turn 

a  right  or  a  left-hand  turn  to  go  to 

the  next  waypoint 

Turning  Statuses 

Turning, 

Indicates  whether  or  not  the  missile  is 

Not_Turning 

currently  turning 

Data  objects: 

The  following  data  objects  are  required  by  this  part  and  defined  as  generic 
formal  parameters  to  the  Crosstrack_and_Heading_Error_Operations  package: 
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1 

Name 

Type 

1 

Value 

Description  | 

1 

E 

Navigation 

1 

'FIRST 

Used  to  access  first  element  of 

1 

Indices 

1 

arrays  dimensioned  by  Navigation 
Indices 

1 

N 

Navigation 

1 

'SUCC(E) 

Used  to  access  second  element  of 

1 

1 

Indices 

1 

arrays  dimensioned  by  Navigation 
Indices 

1 

U 

Navigation 

1 

'LAST 

Used  to  access  last  element  of 

1 

1 

Indices 

1 

arrays  dimensioned  by  Navigation 
Indices 

1 

X 

Unit  Indices 

1 

' FIRST 

Used  to  access  first  element  of 

1 

Indices 

1 

1 

arrays  dimensioned  by  Unit 

Indices 

1 

Y 

Unit  Indices 

1 

'SUCC(X) 

Used  to  access  second  element  of 

1 

1 

Indices 

1 

1 

arrays  dimensioned  by  Unit 

Indices 

1 

Z 

Unit  Indices 

1 

'LAST 

Used  to  access  last  element  of 

1 

1 

Indices 

1 

1 

arrays  dimensioned  by  Unit 

Indices 

1 

Earth  Radius 

Earth 

1 

n/a 

Radius  of  the  Earth 

1 

Distances 

1 

3.3.4.1.9.2.10.1.8  LIMITATIONS 
None. 


3.3.4.1.9.2.10.2  COMPUTE_VHEN_NOT_TURNING  (PROCEDURE  BODY)  UNIT  DESIGN 

This  part  computes  the  crosstrack  and  heading  error  for  a  missile  in  nonturning 
flight. 


3.3.4.1.9.2.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R175. 


3.3.4.1.9.2.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.1.9.2.10.2.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 
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|  Name 

1  Type 

Mode 

Description 

|  Uni  t 

|  Unit  Vectors 

in 

Unit  radial  vector  to  the  missile 

|  Radial  M 

extending  outward  from  the  origin 

I 

of  the  Earth-centered  reference 

frame 

|  Unit 

j  Unit  Vectors 

in 

Segment  AB  unit  normal  vector 

j  Normal  B 

j  Ground 

|  Velocity 

in 

Missile  ground  velocity  with  N  and  E 

j  Velocity 

j  Vectors 

components 

j  Crosstrack 

j  Segment 

out 

Missile  displacement  normal  to  the 

j  Error 

j  Distances 

commanded  ground  track;  is  positive 

when  missile  is  to  the  right  as 

vieved  in  the  direction  of  flight 

j  Heading 

|  Angles 

out 

Difference  between  the  current 

j  Error 

missile  heading  and  the  desired 

heading 

3.3.4.1.9.2.10.2.4  LOCAL  DATA 


Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type 

Description 

|  D  H  D  C 

1  Sin  Cos  Ratio 

Used  for  intermediate  calculations 

Dot  Prod 

Sin  Cos  Ratio 

Dot  product  result,  which,  due  to  the 

Result 

geometry,  equals  the  angle  between  the 
desired  UR  M  and  the  actual  UR  M 

|  N_H_D_C 

j  Sin_Cos_Ratio 

Used  for  intermediate  calculations 

3.3.4.1.9.2.10.2.5  PROCESS  CONTROL 
No*  applicable. 


3.3.4.1.9.2.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Waypoint  Steering.Crosstrack_and_Heading_Error_Operations) 
procedure  Computejfhen  Not_Turning 

(Unit_RadIal_M  :  in  Unit_Vectors; 

Unit_Normal_B  :  in  Unit^Vectors; 

Ground_Velocity  :  in  Velocity  Vectors; 

Cross track_Error  :  out  SegmentJ5istances; 

Heading JSrror  :  out  Angles )~is 


-  — local  declarations- 
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Dot_Prod_Result  :  Sin_Cos_Ratio; 
D_H_D_C  :  Sin_Cos~Ratio; 
N  H  D  C  :  Sin  Cos  Ratio; 


— begin  procedure  Compute_When_Not_Turning- 


begin 

—  — get  the  sine  of  the  angle  (which  approximately  equals  the  angle) 

—  — between  the  actual  and  desired  UR_M, 

—  — and  then  compute  crosstrack  distance/error 

Dot_Prod_Result  Dot_Product  (Left  ->  Unit_Radial_M, 

Right  »>  Unit  Normal_B); 

Cross  track_Error  :-  Dot_Prod_Result  *  Earth_RacTius; 

—  — compute  heading  error 

N_H_D_C  :«  -  UnitNormal  B(Z); 

D_H_D_C  Unit_Normal_BTY)  *  Unit  Radial  M(X)  - 
Uni  t_Normal~B(X)  *  UnitJladialjUY)} 

Heading  3rror  :«  Arctan((N_H  DC*  Ground_Velocity(N)  - 

D_H~D_C  *  Gr ound~Veloci ty ( E ) )  / 

(D_H~D_C  *  Ground~V«loci ty(N)  + 

N_H~D_C  *  Ground~Velocity(E)  )  ) ; 

end  Compute_Vhen_Not_Turning; 


3.3.4.1.9.2.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  subprograms  are  required  by  this  part  and  defined  as  generic 
formal  parameters  to  the  Crosstrack_and_Heading_Error_Operations  package: 
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|  Name  |  Type  |  Description 


function 


function 


function 


«/tl 


function 


Dot_ 
Product 
Arc tan 


function 

function 


Multiplication  operator  defining  the  operation: 
Sin_Cos_Ratio  *  Earth_Distances  =>  j 

Segment_Distances 

Multiplication  operator  defining  the  operation:  j 

Sin_Cos_Ratio  *  Segment_Distances  =»>  j 

Segment~Di stances  j 

Multiplication  operator  defining  the  operation: 

Sin_Cos_Ratio  *  Velocities  *>  Velocities 
Division~operator  defining  the  operation:  j 

Velocities  /  Velocities  ->  Tan_Ratio  j 

Dot  product  function  j 

Arctangent  function  j 


Data  types: 

The  following  data  types  are  required  by  this  part  and  defined  as  generic 
formal  parameters  to  the  Crosstrack_and_Heading_Error_Operations  package: 


|  Name  |  Type  |  Description 


Nav i ga  t i onlnd ices 

Unitlndices 

Angles 

Earth_Distances 

Segment_ 

Distances 

Sin_Cos_Ratio 

Tan_Ratio 

Velocities 

Uni t_Vec tors 

Velocity_Vectors 


discrete 

type 

discrete 

type 

floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
array 

array 


Data  type  used  to  dimension  Velocity_ 
Vectors 

Data  type  used  to  dimension  Unit_Vectors 

Data  type  of  angular  measurements 

Data  type  used  to  define  distance 
measurements  of  the  Earth's  radius 

Data  type  used  to  define  distance 
measurements  of  the  navigation  segments 

Data  type  of  results  of  sine/cosine 
operations 

Data  type  of  tangent  operations 

Data  type  of  velocity  measurements 

Array,  dimensioned  by  Unit_Indices,  of 
Sin_Cos  Ratio 

Array,  dimensioned  by  Navigation_ 
Indices,  of  Velocities 


Data  objects: 

The  following  data  objects  are  required  by  this  part  and  defined  as  generic 
formal  parameters  to  the  Cross track_and_Heading_Error_Operat ions  package: 
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|  Name  |  Type  |  Value  |  Description 


1  E 

1 

I 

Navigation  |  'FIRST 

Indices  j 

1 

Used  to  access  first  element  of 
arrays  dimensioned  by  Navigation 
Indices 

j  N 

1 

1 

Navigation_  j  'SUCC(E) 
Indices  | 

1 

Used  to  access  second  element  of 
arrays  dimensioned  by  Navigation 
Indices 

1  u 

1 

Navigation_  j  'LAST 
Indices 

Used  to  access  last  element  of 
arrays  dimensioned  by  Navigation 
Indices 

|  X 

1 

Unit_Indices  |  'FIRST 
Indices 

1 

Used  to  access  first  element  of 
arrays  dimensioned  by  Unit 

Indices 

1  Y 

1 

Unitlndices  j  'SUCC(X) 
Indices  t 

1 

Used  to  access  second  element  of 
arrays  dimensioned  by  Unit_ 

Indices 

1  z 

1 

1 

Unit_Indices  j  'LAST 
Indices  j 

Used  to  access  last  element  of 
arrays  dimensioned  by  Unit 

Indices 

j  Earth_Radius 

Earth  j  n/a 

Distances  j 

Radius  of  the  Earth 

3.3.4.1.9.2.10.2.8  LIMITATIONS 


None. 


3.3.4.1.9.2.10.3  COMPUTE  (PROCEDURE  BODY)  UNIT  DESIGN 

This  part  computes  the  crosstrack  and  heading  error  for  a  missile  in  turning  or 
nonturning  flight. 


3.3.4.1.9.2.10.3.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R174. 


3.3.4.1.9.2.10.3.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.1.9.2.10.3.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 
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|  Name 

1  Type 

Mode 

Description  | 

Distance 

I  Segment 

in 

Distance  from  missile  position  to 

to  B 

j  Distances 

the  current  waypoint,  B 

Nonturning 

I  Segment 

in 

Distance  from  point  of  tangency  of 

Distance 

j  Distances 

turn  circle  and  next  course  segment, 
BC,  to  next  waypoint,  C 

Unit 

|  Unit  Vectors 

in 

Unit  radial  vector  to  the  missile 

RadlalM 

extending  outward  from  the  origin 
of  the  Earth-centered  reference 
frame 

Unit 

Normal  B 

j  Unit_Vectors 

in 

Segment  AB  unit  normal  vector 

Unit_ 

Tangent  B 

j  Unit_Vectors 

in 

Segment  AB  unit  tangent  vector 

Turn 

j  Turning 

in 

Direction  of  turn  required  to  go 

Direction 

Directions 

from  waypoint  B  to  waypoint  C 

Turn  Status 

j  Turning 

in 

Indicates  if  the  missile  is  in 

j  Statuses 

turning  or  nonturning  flight 

Ground 

j  Velocity 

in 

Missile  ground  velocity  with  N  and  E 

Velocity 

Veci  .<  ~ 

components 

Turn_Radius 

j  Segment _ 
Distances 

in 

Desired  missile  turn  radius 

Cross track 

j  Segment 

out 

Missile  displacement  normal  to  the 

Error 

j  Distances 

commanded  ground  track;  is  positive 
vhen  missile  is  to  the  right  as 
vieved  in  the  direction  of  flight 

Heading_ 

Error 

j  Angles 

out 

Difference  betveen  the  current 
missile  heading  and  the  desired 
heading 

3.3.4.1.9.2.10.3.4  LOCAL  DATA 
None. 


3.3.4.1.9.2.10.3.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.1.9.2.10.3.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Vaypoint_Steering.Crosstrack_and_Heading_Error_Operations) 
procedure  Compute 


(Distance_to_B 

in 

Segment_Distances; 

Nonturning  Distance 

in 

Segment_Dis  tances ; 

Unit_RadiaI_M 

in 

Uni t_Vec tors; 

Uni  t_Norraal~B 

in 

Unit_Vectors; 

Uni  t_TangenI_B 

in 

Unit-Vectors; 

Turn_Direction 

in 

TurnIng_Directions; 

Turn_Status 

in 

Turning~Statuses ; 
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Ground_Velocity 

:  in 

Turn  Radius 

:  in 

Cross track_Error 

:  out 

Heading_Error 

:  out 

begin 

if  Turn_Status  =  Turning  then 
Compute_When_Turning 

(Distance_to_B 
Nonturning  Distance 
Unit_RadiaI_M 
Unit~Normal_B 
Uni t~Tangent_B 
Turn_Di recti on 
Ground_Veloci ty 
Turn_Radius 
Cr os s  t r  ack JBr  r o  r 
Heading_Error 

else 

Compute_When_Not  Turning 

(UnTt_Radial_M  -> 
Unit_Normal_B  ■> 
Ground_Velocity  -> 
Cross track_Error  ■> 
Heading_Error  -> 

end  if; 
end  Compute; 


Veloci ty_Vectors ; 
Segment_Di stances ; 
Segment_Dis tances ; 
Angles)  is 


=*>  Distance_to_B 
*>  Nonturning  Distance 
»>  Unit_RadiaI_M 
■>  Uni t_Normal~B 
->  Unit~Tangent_B 
»>  Turn_Direction 
*>  Ground_Velocity 
»>  Turn_Radius 
->  CrosItrack_Error 
»>  Heading_Error 


Unit_Radial_M  , 
Uni t_Normal_B  , 
Ground_Velocity  , 
Cross  track  Error  , 
HeadingError  ) ; 


); 


3.3.4.1.9.2.10,3.7  UTILIZATION  OP  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  contained  in  the  Crosstrack_and_Heading_Error_Operations  package. 


|  Name 


Type  |  Description 


Compute_Vhen_Turning  |  procedure 
Compute_Vhen_Not_Turning  |  procedure 


Computes  the  crosstrack  and  heading 
errors  when  the  missile  is  in 
turning  flight 

Computes  the  cross track  and  heading 
errors  when  the  missile  is  in 
nonturning  flight 


Data  types: 

The  following  data  types  are  required  by  this  part  and  defined  as  generic 
formal  parameters  to  the  Crosstrack_and_Heading_Error_Operations  package: 
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I  Name 


I  Type 


Description 


Navigation_Indices 

Unit_Indices 

Angles 

Earth_Distances 

Segment_ 

Distances 

Sin_Cos_Ratio 

Tan_Ratio 

Velocities 

Unit_Vectors 

Veloci ty_Vectors 


discrete 

type 

discrete 

type 

floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
array 

array 


Data  type  used  to  dimension  Veloci ty_ 
Vectors 

Data  type  used  to  dimension  Unit_Vectors 

Data  type  of  angular  measurements 

Data  type  used  to  define  distance 
measurements  of  the  Earth's  radius 

Data  type  used  to  define  distance 
measurements  of  the  navigation  segments 

Data  type  of  results  of  sine/cosine 
operations 

Data  type  of  tangent  operations 

Data  type  of  velocity  measurements 

Array,  dimensioned  by  Unit_Indices,  of 
Sin_Cos  Ratio 

Array,  dimensioned  by  Navigation_ 
Indices,  of  Velocities 


The  following  table  describes  the  data  types  required  by  this  part  and  defined 
in  the  package  specification  of  VaypointjSteering: 


|  Name 


Range  |  Description 


I 


Turning_Directions  |  Left  Turn, 

RigKtJTurn 

Turning_Statuses  j  Turning, 

j  Not_Turning 


Indicates  if  the  missile  needs  to  make  | 
a  right  or  a  left-hand  turn  to  go  to 
the  next  vaypoint 

Indicates  whether  or  not  the  missile  isj 
currently  turning  j 


3.3.4.1.9.2.10.3.8  LIMITATIONS 


None. 


3.3.4. 1.9.3  TURN_TEST_0PERATI0NS  (PACKAGE  BODY)  PACKAGE  DESIGN  (CATALOG  #P112-0) 

This  part  contains  the  operations  required  to  determine  if  a  missile  should  be 
in  turning  or  nonturning  flight. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document . 
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3. 3. 4. 1.9. 3.1  REQUIREMENTS  ALLOCATION 

The  following  table  summarizes  the  allocation  of  CAMP  requirements  to  this 
part : 


|  Name 

|  Requirements  Allocation  | 

|  Stop  Test 
|  StartTest 

|  R178  | 

|  R179  | 

3. 3. 4. 1.9. 3. 2  LOCAL  ENTITIES  DESIGN 
None. 

3. 3. 4. 1.9. 3. 3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

The  following  generic  parameters  were  previously  defined  when  this  part  was 
specified: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

Type 

|  Description  | 

|  Distances 

floating 

|  Data  type  of  distance  measurements  | 

3.3.4. 1.9. 3.4  LOCAL  DATA 


None. 


3. 3. 4. 1.9. 3. 5  PROCESS  CONTROL 


Not  applicable. 


3. 3. 4. 1.9. 3. 6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Waypoint_Steering) 
package  body  Turn_Test_Operations  is 

function  Stop  Test 

(Distance_to_B  :  Distances; 

Nonturning_Distance  :  Distances; 

Lead  Distance  :  Distances) 
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return  Turning_Statuses  is  separate; 

function  Start  Test 

(Dlstance_to_B  :  Distances; 

Turning_Distance  :  Distances; 

Lead_Distance  :  Distances) 

return  Turning_Statuses  is  separate; 

end  Turn_Test_Operations; 


3.3.4. 1.9. 3. 7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

|  Range  | 

Description  | 

|  Turning  Statuses 

1 

|  Turning,  j 

|  Not_Turning  j 

Indicates  whether  or  not  the  missile  is 
currently  turning 

3.3.4. 1.9. 3. 8  LIMITATIONS 


None. 


3. 3. 4. 1.9. 3. 9  LLCSC  DESIGN 


None. 


3.3.4.1.9.3.10  UNIT  DESIGN 

3.3.4.1.9.3.10.1  STOP_TEST  (FUNCTION  BODY)  UNIT  DESIGN 

This  part  determines  whether  a  missile  should  be  in  turning  or  nonturning 
flight. 


3.3.4.1.9.3.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R178. 
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3.3.4.1.9.3.10.1.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.1.9.3.10.1.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name  |  Type  |  Mode  |  Description 


Distance 

|  Distances 

1 

In 

to_B 

1 

Non turning 

|  Distances 

1 

In 

Distance 

1 

1 

Lead 

|  Distances 

1 

1 

In 

Distance 

1 

1 

1 

1 

Distance  from  missile  position  to 
current  waypoint,  B 

Distance  from  point  of  tangency  of  turn 
turn  circle  and  next  course  segment, 
BC,  to  the  next  waypoint,  C 
Distance  at  which  a  turn  is  started  or 
stopped  early  to  compensate  for  the 
delay  in  missile  roll  dynamics 


3.3.4.1.9.3.10.1.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

|  Type  |  Value 

|  Description  | 

|  Turn  Status  | 
1  "  1 

Turning_  |  N/A 
Statuses  j 

|  Turning  or  nonturning  status  of  the 
j  missile 

3.3.4.1.9.3.10.1.5  PROCESS  CONTROL 


Not  applicable. 


3.3.4.1.9.3.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Vaypoint_Steering.Turn_Test_Operations) 
function  Stop_Test 

(Distance_to_B  :  Distances; 

Nonturning_Distance  :  Distances; 

Lead_Distance  :  Distances)  return  Turning_Statuses  is 


—  —declaration  section- 
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TurnStatus  :  Turning_Statuses  :=  Turning; 

— begin  function  Stop_Test- 
begin 

if  Distance_to_B  <»  (Lead_Di stance  +  Nonturning_Distance)  then 
TurnStatus  :«  Not_Turning; 
end  if; 

return  Turn_Status; 
end  Stop_Test; 

3.3.4.1.9.3.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  parameters  to  the  Turn_Test_Operations  package: 


|  Name  |  Type 

|  Description 

1 

|  Distances  |  floating 

|  Data  type  of  distance  measurements 

1 

The  following  table  summarizes  the  types  required  by  this  part 
the  package  specification  of  Vaypoint_Steering: 

and 

defined  in 

|  Name  | 

Range 

|  Description 

1 

|  Turning  Statuses 

Turning, 

Indicates  whether  or  not 

the 

missile  is | 

1  1 

Not_Turning 

currently  turning 

1 

3.3.4.1.9.3.10.1.8  LIMITATIONS 


None. 


3.3.4.1.9.3.10.2  START_TEST  (FUNCTION  BODY)  UNIT  DESIGN 

This  part  determines  whether  a  missile  should  be  in  turning  or  nonturning 
flight. 
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3.3.4.1.9.3.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R179. 


3.3.4.1.9.3.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.1.9.3.10.2.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

Mode 

Description  | 

Distance 

|  Distances 

In 

Distance  from  missile  position  to 

to  B 

current  waypoint,  B 

Turning 

|  Distances 

In 

Distance  from  point  of  tangency  of  turn 

Distance 

1 

turn  circle  and  current  course  segment, 

1 

BC,  to  the  current  vaypoint,  C 

Lead 

|  Distances 

In 

Distance  at  vhich  a  turn  is  started  or 

Distance 

stopped  early  to  compensate  for  the 

1 

delay  in  missile  roll  dynamics 

3.3.4.1.9.3.10.2.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

Type  | 

Value 

Description  | 

|  Turn  Status 

1 

Turning_  | 
Statuses  j 

N/A 

Turning  or  nonturning  status  of  the  j 

missile  j 

3.3.4.1.9.3.10 

2.5  PROCESS 

CONTROL 

Not  applicable. 


3.3.4.1.9.3.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Vaypoint_Steering.Turn_Test_Operations) 
function  Start  Test 

(Dlstance_to_B  :  Distances; 

Turning  Distance  :  Distances; 
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Lead_Distance  :  Distances)  return  Turning_Statuses  is 


—  — declaration  section- 


Turn_Status  :  Turning_Stc.tuses  :*  Not_Turning; 


— begin  function  Start_Test- 


begin 

if  Distance_to_B  <»  (Lead_Di stance  +  Turning_Distance)  then 
Turn_Status  :*  Turning; 
end  if; 

return  Turn_Status; 
end  Start_Test; 

3.3.4.1.9.3.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsevhere  in  the  parent  top  level  component: 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  parameters  to  the  Turn_Test_Operations  package: 

|  Name  |  Type  |  Description 


|  Distances  |  floating  |  Data  type  of  distance  measurements  l 


The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
the  package  specification  of  Waypoint_Steering: 


|  Name  |  Range  |  Description 


|  Turning_Statuses  |  Turning,  Indicates  whether  or  not  the  missile  is 

j  j  Not  Turning  currently  turning 


3.3.4.1.9.3.10.2.8  LIMITATIONS 


None. 
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3.3.4. 1.9.4  STEERING_VECTOR_OPERATIONS_WITH_ARCSIN  (PACKAGE  BODY)  PACKAGE  DESIGN 
(CATALOG  #P1048-0) 

This  package  contains  operations  to  do  the  following:  o  Initialize  the 
waypoint  steering  vectors  when  supplied  with  the  latitude  and  longitude  of  the 
past,  current,  and  next  waypoints  o  Update  the  waypoint  steering  vectors  when 
supplied  with  the  latitude  and  longitude  of  the  "new"  waypoint,  C. 

The  waypoint  steering  vectors  for  a  course  segment,  extending  from  waypoint  A 
to  waypoint  B,  are  the  segment  unit  normal  vector  (UN_B)  and  the  segment  unit 
tangent  vector  (UT_B). 

It  does  not  make  the  assumption  that  alphasin(alpha)  when  doing  its 
computations. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3.3.4. 1.9. 4.1  REQUIREMENTS  ALLOCATION 

The  following  table  summarizes  the  allocation  of  CAMP  requirements  to  this 
part: 


|  Name  |  Requirements  Allocation  | 


|  Initialize  |  N/A 
|  Update  |  N/A 


3. 3. 4. 1.9. 4. 2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.4. 1.9. 4. 3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

The  following  generic  parameters  were  previously  defined  with  the  specification 
for  this  part. 

Data  types: 

The  following  table  summarizes  t^e  generic  formal  types  required  by  this  part: 
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|  Name  |  Type 


Description 


Indices 

Earth_Distances 

Segment_ 

Distances 

Earth_Positions 

Radians 

Sin_Cos_Ratio 

Unit  Vectors 


discrete 

type 

floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
array 


Used  to  dimension  Unit_Vectors 

Data  type  used  to  define  distance 
measurements  of  the  Earth's  radius 
Data  type  used  to  define  distance 
measurements  of  the  navigation  segments 
Data  type  used  to  define  latitude  and 
longitude  measurements 
Radian  units  of  angular  measurement 

Data  type  used  to  define  results  of  a  sine 
or  cosine  function 

Array  of  "Sin_Cos_Ratio"  dimensioned  by 
Indices 


Data  objects: 

The  following  table  describes  the  generic  formal  objects  required  by  this  part: 


|  Name 

Type 

|  Value 

|  Description  | 

Earth  Radius 

Earth 

|  n/a 

|  Radius  of  the  Earth  | 

1  1 

" 

Distances 

I 

Subprograms : 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 


Name 

Type 

Description 

"*« 

function 

Multiplication  operator  defining  the  operation: 

Sin  Cos  Ratio  *  Earth  Distances  ■> 

Segmen t  Di s  t  ances 

n /n 

function 

Operator  defining  the  operation: 

Unit  Vectors  /  Sin  Cos  Ratio  »>  Unit  Vectors 

Arcsin 

function 

Arcsin  function  (must  return  radians) 

Cross 

procedure 

Cross  product  function 

Product 

Vector 

function 

Calculates  the  length  of  a  vector 

LengtK 

Sin_Cos 

procedure 

Calculates  the  sine  and  cosine  of  an  input  value 

3. 3. 4. 1.9. 4. 4  LOCAL  DATA 
Data  objects: 
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The  following  table  describes  the  data  objects  maintained  by  this  part: 


Name  |  Type  |  Value  |  Description 


Unit  Radial  B 


Unit  Vectors 


N/A 


Unit  Radial  C 


Unit  Vectors 


N/A 


Unit  radial  vector  to  waypoint  B 
extending  outwards  from  the 
origin  of  the  Earth-centered 
reference  frame  towards  waypoint 
B 

Unit  radial  vector  to  waypoint  C 
extending  outwards  from  the 
origin  of  the  Earth-centered 
reference  frame  towards  waypoint 
C 


3. 3.4.1. 9.4.5  PROCESS  CONTROL 
Not  applicable. 


3. 3. 4. 1.9. 4. 6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

with  GeometrlcOperations; 
separate  (Waypoint  Steering) 

package  body  SteerTng_Vector_Operations_with_Arcsin  is 
package  Geo  renames  Geometric_Operations; 


—  — instantiate  required  parts- 


function  U_R_Vector  is  new 

Geo.Unit_Radial_Vector  (Indices 

Earth_Positions 
Sin_Cos_Ratio 
Unit  Vectors 


*>  Indices, 

->  Earth_Positions, 
•>  Sin_Cos_Ratio, 

->  Unit  Vectors); 


procedure  Compute_Segment_and_U_Nl_Vector  is  new 

Geo. Compute  Segment  and  Unit  Normal  Vector  with  Arcsin 


(Indices 
Earth_Distances 
Segmen  t_Di s tances 
Radians 
Sin_Cos_Ratio 
Unit  Vectors 
EartK  Radius 


»>  Indices, 

->  Ear th_Dis tances, 

»>  Segmen t_Dis tances, 

->  RadiansT 

-•>  Sm_Cos_Ratio, 

=>  Unit  Vectors, 

»>  EartK  Radius); 


—  — local  declarations- 
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Unit_Radial_B  :  Unit_Vectors; 
Unit_Radial~C  :  Unit~Vectors; 

end  Steering_Vector_Operations_with_Arcsin; 


3. 3. 4. 1.9. 4. 7  UTILIZATION  OF  OTHER  ELEMENTS 

The  following  library  units  are  with'd  by  this  part: 

1.  Geometric_Operations  package  (Geo) 

UTILIZATION  OF  EXTERNAL  ELEMENTS: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  external  subroutines  and  task  entries 
required  by  this  part: 


|  Name  j  Type  |  Source  |  Description 


|  Unit_Radial_Vector 

generic  |  Geo 
function  j 

Computes  a  unit  radial  vector 

|  Compute_Segment_and_ 
j  Unit_Normal_Vector_ 
j  with_Arcsin 

generic  |  Geo 
function  j 

1 

Computes  segment  distance 
and  unit  normal  vector 

3. 3.4. 1.9. 4. 8  LIMITATIONS 


None. 


3.3.4. 1.9. 4. 9  LLCSC  DESIGN 


None. 


3.3.4.1.9.4.10  UNIT  DESIGN 

3.3.4.1.9.4.10.1  INITIALIZE  (PROCEDURE  BODY)  UNIT  DESIGN 

This  part  initializes  the  waypoint  steering  vectors  when  supplied  with  the 
latitude  and  longitude  of  the  past  (A),  present  (B),  and  next  (C)  waypoints. 

This  part  initializes  the  waypoint  steering  vectors  for  the  "current"  course 
segment  AB,  as  well  as  for  the  "next"  course  segment  BC. 


3.3.4.1.9.4.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R170. 
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3.3.4.1.9.4.10.1.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.1.9.4.10.1.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1 

Type 

Mode 

Description  | 

Vaypoint  A  Lat, 

1 

Earth  Positions 

in 

Latitude  and  longitude  of 

Waypoint  A  Long 

1 

the  "previous"  waypoint 

Vaypoint  B  Lat, 

1 

Earth  Positions 

in 

Latitude  and  longitude  of 

Vaypoint  B  Long 

1 

the  "current"  waypoint 

Vaypoint  C  Lat, 

1 

Earth  Positions 

in 

Latitude  and  longitude  of 

Vaypoint  C  Long 

1 

the  "next"  waypoint 

Unit  Normal  B, 

1 

Unit  Vectors 

out 

Unit  normal  vectors  for 

Unit  Normal  C 

1 

segments  AB  and  BC 

Unit  Tangent  B, 

Unit  Vectors 

out 

Unit  tangent  vectors  for 

Unit  Tangent  C 

1 

segments  AB  and  BC 

Segment  BC 

1 

Segment 

out 

Great  circle  ardength 

Distance 

1 

Distances 

between  waypoints  B  and  C 

3.3.4.1.9.4.10.1.4  LOCAL  DATA 


Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

Type 

Value 

Description  | 

Temp  UN  B 

Unit  Vectors 

N/A 

Temporary  Unit  Normal  B  vector 

Temp  UN  C 

Unit  Vectors 

N/A 

Temporary  Unit  Normal  C  vector 

Unit_Radial_A 

Unit_Vectors 

N/A 

Unit  radial  vector  pointing  to 
waypoint  A 

VLength 

Sin_Cos_Ratio 

N/A 

Vector  length 

3.3.4.1.9.4.10.1.5  PROCESS  CONTROL 


Not  applicable. 


3.3.4.1.9.4.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
procedure  Initialize 

(Vaypoint_A_Lat  :  in  Ear th_Posit ions; 
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Waypoint_A_Long  : 
Waypoint_B_Lat  : 
Waypoint_B_Long  s 
Waypoint_C_Lat  : 
Waypoint_C  Long  : 
Unit  NormaI_B  : 
Unit~Normal_C  : 
Unit~Tangent_B  : 
Unit~Tangent~C  : 
Segment_8C_DTstance  : 


— declaration  section- 


in  Earth_Positions; 
in  Earth_Positions; 
in  Earth_Positions; 
in  Earth_Positions; 
in  Earth_Positions; 
out  Uni t_Vec tors; 
out  Unit_Vectors; 
out  Unit_Vectors; 
out  Unit_Vectors; 
out  Segraent_Distances)  is 


Temp_UN_B  :  Unit_Vectors; 
Temp_UN  C  s  Unit_Vectors; 
Unit_Ra3ial_A  :  Uni t_Vec tors; 
V_Length  :  Sin_Cos_Ratio; 


— begin  procedure  Initialize- 


begin 

— compute  unit  radial  vectors 


UnitRadialA  U_R_Vector(Lat_of  Point  ■> 

Long_of  Point  ■> 
UnitRadialB  U_R_Vector(Lat_of  Point  ■> 

LongoT  Point  -> 
Uni t_Radial_C  s-  U_R_Vector(Lat_of  Point  »> 

Long_oI_Point  ■> 


Vaypoint_A_Lat , 
WaypointALong) ; 
Waypoint_B_Lat , 
Waypoint_B_Long) ; 
Waypoint_C_Lat , 
WaypointCLong) ; 


— compute  UN_B 


TempUNB 

V_Length 
Temp_UN_B 
Unit  Normal  B 


•  ■  Cross_Product(Lef t  ->  Unit_Radial_Bf 
Right  ->  Unit~Radial_A); 
Vector  Length(Temp_UN_B); 

Temp_UN_B  /  V_LengIh; 

: »  Temp~UN_B;  ~ 


— compute  UT_B 

Unit_Tangent_B  Cross_Product(Lef t  ■>  Temp_UN  B, 

Right  ->  Unit_Ra3ial  B); 


— compute  UN_C  and  segment  BC  distance 


Compute_Segment  ■and_U_Nl_Vector 

(Unit_RadialI  ~  ->  Unit_Radial_B, 

Unit~Radial2  ->  Unit_Radial_C, 

Unit~Normal2  ■>  Temp_UN_C, 

Segraent_Di stance  ■>  Segment_BC_Di stance) ; 


Uni t_Normal_C  : »  Temp_UN_C; 
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— compute  UT_C 

Uni t_Tangent_C  :=  Cross_Product(Lef t  =>  Temp_UN  C, 

Right  ->  Unit  Ra3ial  C); 


end  Initialize; 


3.3.4.1.9.4.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  instantiated  in  the  body  of  the  Steering_Vector_Operations 
package : 


|  Name 

Type 

|  Description  | 

1  URVector 
j  ComputeSegmentand 
j  UNIVector 

function 

function 

|  Computes  a  unit  radial  vector 
j  Computes  segment  distance  and  unit 
j  normal  vector 

The  following  table  describes  the  subroutines  required  by  this  part  and  defined 
as  generic  formal  subroutines  to  the  Steering_Vector_Operations  package: 


Name  |  Type  |  Description 


»t  /  ff 


function 


Cross_  |  procedure 
Product  j 

Vector  j  function 
LengtK  j 


Operator  defining  the  operation: 

Unit_Vectors  /  Sin  Cos_Ratio  ■>  Unit_Vectors 
Cross”product  function 

Calculates  the  length  of  a  vector 


Data  types: 

The  following  data  types  are  required  by  this  part  and  defined  as  generic 
parameters  to  the  Steering_Vector_Operations  package: 
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|  Name 


Type  |  Description 


Indices 

Earth_Distances 

Segment _ 
Distances 
Earth_Positions 

Sin_Cos_Ratio 

Unit  Vectors 


discrete 

type 

floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
array 


Used  to  dimension  Unit_Vectors 

Data  type  used  to  define  distance 
measurements  of  the  Earth's  radius 
Data  type  used  to  define  distance 
measurements  of  the  navigation  segments 
Data  type  used  to  define  latitude  and 
longitude  measurements 
Data  type  used  to  define  results  of  a  sine 
or  cosine  function 

Array  of  "Sin_Cos_Ratio"  dimensioned  by 
Indices 


Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  Steering_Vector_Operations: 


|  Name  |  Type  |  Value  |  Description 


Unit  Radial  B 


Unit  Vectors 


N/A 


Unit  Radial  C 


Unit  Vectors 


N/A 


Unit  radial  vector  to  vaypoint  B 
extending  outvards  from  the 
origin  of  the  Earth-centered 
reference  frame  tovards  vaypoint 
B 

Unit  radial  vector  to  vaypoint  C 
extending  outvards  from  the 
origin  of  the  Earth-centered 
reference  frame  tovards  vaypoint 
C 


3.3.4.1.9.4.10.1.8  LIMITATIONS 
None. 


3.3.4.1.9.4.10.2  UPDATE  (PROCEDURE  BODY)  UNIT  DESIGN 

This  part  updates  the  vaypoint  steering  vectors  vhen  supplied  vith  the  latitude 
and  longitude  of  the  "new"  vaypoint,  C. 

The  vaypoint  steering  vectors  for  a  course  segment,  extending  from  vaypoint  A 
to  waypoint  B,  are  the  segment  unit  normal  vector  (UN_B)  and  the  segment  unit 
tangent  vector  (UT_B). 
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3.3.4.1.9.4.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R171. 


3.3.4.1.9.4.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.1.9.4.10.2.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


1 

Name 

Type 

|  Mode 

Description  | 

1 

Waypoint  C  Lat, 

Earth  Positions 

1  *n 

Latitude  and  longitude  of 

i 

Waypoint  C  Long 

the  "next"  waypoint 

1 

Unit  Normal  B, 

Unit  Vectors 

|  out 

Unit  normal  vectors  for 

1 

Unit  Normal  C 

j  in  out 

segments  AB  and  BC 

1 

Unit  Tangent  B, 

Unit  Vectors 

j  out 

Unit  tangent  vectors  for 

1 

Unit  Tangent  C 

. 

j  in  out 

segments  AB  and  BC 

1 

Segment  BC 

Segment 

j  out 

Great  circle  ardength 

1 

Distance 

Distances 

between  waypoints  B  and  C 

3.3.4.1.9.4.10.2.4  LOCAL  DATA 
None. 


3.3.4.1.9.4.10.2.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.1.9.4.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update 

( Way po i n t_C_La t 
Vaypoint_C  Long 
Unit_NormaI_B 
Unit_Normal_C 
Uni t_Tangen t_B 
Unit_Tangent  C 
Segmen  t_BC_Dls  tance 

begin 

— advance  "C"  vectors  into  "B" 

Unit  Radial  B  :>  Unit  Radial  C: 


in  Earth_Positions; 

in  Earth~Positions; 

out  Unit_7ectors; 
in  out  Unit_Vectors; 

out  Unit_Vectors; 
in  out  Unit_Vectors; 

out  Segment_Distances)  is 


vectors 


CAMP  Software  Detailed  Design  Document 


Page  469 


Unit_Normal_B  Unit_Normal_C; 

Unit_Tangent_B  :=  Unit_TangenI_C; 

— calculate  new  values 

Unit_Radial_C  :«■  U_R_Vector(Lat_of  Point  ->  Waypoint_C_Lat, 

Long_oI_Point  =■>  Waypoint_C_Long) ; 

Compute_Segment  and_U_Nl_Vector 

(UnitJRadialT  »>  Unit_Radial  B, 

Uni t_Radial2  ->  Uni t_Radial~C, 

Unit_Normal2  ->  Unit_Normal_C, 

Segment_Distance  ■>  Segment_BC_Di stance) ; 

Unit_Tangent_C  :-  Cross  Product(Left  ->  Unit_Normal_C, 

Right  ->  Unit_Radial_C); 


end  Update; 


3.3.4.1.9.4.10.2.7  UTILIZATION  CF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsevhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  instantiated  in  the  body  of  the  Steering_Vector_Operations 
package: 


|  Name 

Type 

|  Description  | 

URVector 

Compute  Segment  and 
U_Nl_Vector 

function 

function 

|  Computes  a  unit  radial  vector  j 
|  Computes  segment  distance  and  unit  i 
j  normal  vector  j 

The  following  table  describes  the  subroutines  required  by  this  part  and  defined 
as  generic  formal  subroutines  to  the  Steering_Vector_Operations  package: 


|  Name  | 

Type 

Description  | 

|  Cross_  j 
j  Product  j 

procedure 

Cross  product  function 

1 

Data  types: 

The  following  data  types  are  required  by  this  part  and  defined  as  generic 
parameters  to  the  Steering_Vector_Operations  package: 
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Name 


Type  |  Description 


Indices 

EarthDistances 

Segment _ 
Distances 
Earth_Positions 

Sin_Cos_Ratio 

Unit  Vectors 


discrete 

type 

floating 
point  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 
array 


Used  to  dimension  Unit_Vectors 

Data  type  used  to  define  distance 
measurements  of  the  Earth's  radius 
Data  type  used  to  define  distance 
measurements  of  the  navigation  segments 
Data  type  used  to  define  latitude  and 
longitude  measurements 
Data  type  used  to  define  results  of  a  sine 
or  cosine  function 

Array  of  "Sin_Cos_Ratio"  dimensioned  by 
Indices 


Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  Steering_Vector_Operations: 


|  Name 

Type 

Value 

Description  | 

|  UnitRadialB 

1 

1 

UnitVectors 

N/A 

Unit  radial  vector  to  vaypoint  B 
extending  outwards  from  the 
origin  of  the  Earth-centered 
reference  frame  towards  waypoint 

B 

Unit  radial  vector  to  waypoint  C 
extending  outwards  from  the 
origin  of  the  Earth-centered 
reference  frame  towards  waypoint 

c 

|  Unit_Radial_C 

1 

1 

Unit_Vectors 

N/A 

3.3.4.1.9.4.10.2.8  LIMITATIONS 


None. 


3.3.4.1.10  UNIT  DESIGN 

3.3.4.1.10.1  COMPUTE  TURN  ANGLE  AND_DIRECTI0N  (PROCEDURE  BODY)  UNIT  DESIGN 
(CATALOG  #PT08-07 

Using  the  waypoint  steering  vectors,  this  part  computes  the  tangent  of  one-half 
the  turn  angle  along  with  the  turn  direction. 


3.3.4.1.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R172. 
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3.3.4.1.10.1.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.1.10.1.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

The  following  generic  parameters  were  defined  when  this  part  was  previously 
specified. 

Data  types: 

The  following  “able  describes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Unit_Vectors 
j  Sin_Cos_Ratio 
j  Tan_Ratio 

|  private  |  One-dimensional,  three-element  arrays  | 

j  defining  the  waypoint  steering  vectors  j 

|  floating  j  Data  type  of  results  of  sine/cosine  j 

j  point  type  j  operations  j 

j  floating  j  Data  type  of  results  of  tangent  operations  j 

|  point  type  |  | 

Subprograms: 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 

|  Name  | 

Type 

Description  | 

1  "+"  1 

1 

|  "/"  j 

1  1 

|  Dot_Product  | 

function 

function 

function 

Addition  operator  defining  the  operation: 

Tan_Ratio  +  Sin_Cos  Ratio  ->  Tan_Ratio 

Division  operator  delining  the  operation: 

Sin_Cos_Ratio  /  Tan_Ratio  »>  Tan_Ratio 

Calculates  the  dot  product  of  two~Unit_Vectors 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 
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|  Name 


Type  |  Mode  |  Description 


Unit  Normal  C 

|  Unit  Vectors 

1 

in 

Unit  Tangent_B 

1 

|  Unit_Vectors 

l 

in 

Unit  Tangent_C 

|  Unit_Vectors 

1 

1 

in 

Tan  of  One  Half 

1  Tan  Ratio 

1 

out 

Turn_Angle 


Turn  Direction 


Turning 

Directions 


out 


Segment  BC  unit  normal  vector 
with  x,  y,  and  z  components 
Segment  AB  unit  tangent  vector 
with  x,  y,  and  z  components 
Segment  BC  unit  tangent  vector 
with  x,  y,  and  z  components 
Tangent  of  one-half  the  angle 
between  the  current  course 
segment  and  the  next  course 
segment 

Indicates  if  missile  is  to 
make  a  right-  or  left-hand 
turn 


3.3.4.1.10.1.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

Type 

Value 

Description  | 

I  Cos  of  Turn  Angle, 

Sin  Cos 

N/A 

Sine  and  cosine  of  the  angle 

I  Sin  of  Turn  Angle 

Ratio 

between  the  current  and  next 

1 

course  segments 

3.3.4.1.10.1.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.1.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Waypoint_Steering) 
procedure  Compute_Turn_Angle_ 

(Unit_Normal_C 
Uni t_Tangent_B 
Unit_Tangent_C 
Tan_of  One_Hall 
Turn  Direction 


:  in 

Unit_Vectors; 

:  in 

Uni t~Vec tors; 

:  in 

Unit~Vectors; 

_Turn_Angle  : 

out  Tan_Ratio; 

out  Turning  Directions)  is 


—  — declaration  section- 


:  Tan_Ratio  renames  Tan_of_One_Half_Turn  Angle; 


Tan  of  Half 
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Cos_of_Turn_Angle  :  Sin_Cos_Ratio; 
Sin  of  Turn  Angle  :  Sin  Cos~Ratio; 


— begin  procedure  Compute_Turn_Angle_and_Direction- 


begin 

Cos_of_Turn_Angle  :«  Dot_Product(Lef  t  ■>  Unit_Tangent_B, 

Right  ->  Unit_Tangent~C) ; 

Sin_of_Turn_Angle  Dot_Product(Lef t  ->  Unit_Tangent_B, 

Right  ->  Unit_Norraal_C); 

TanofHalf  :»  ABS(Sin_of_Turn_Angle  / 

(Tan_Ratio(1.0)  +  Cos_of_Turn_Angle)) ; 

if  Sin_of  Turn  Angle  <0.0  then 
Turn_DTrectTon  :■  Left_Turn; 
else 

Turn_Di recti on  :■  Right_Turn; 
end  if; 

end  Compu  t  e_Turn_Angle_and_Di  r ec  t  i  on ; 


3.3.4.1.10.1.7  UTILIZATION  OP  OTHER  ELEMENTS 
None. 


3.3.4.1.10.1.8  LIMITATIONS 


None. 


3.3.4.1.10.2  DI STANCE_TO_CURRENT_WA YP0INT  (FUNCTION  BODY)  UNIT  DESIGN  (CATALOG 
#P110-0) 

This  part  computes  the  distance  from  the  missile's  position  to  the  current 
waypoint,  B. 


3.3.4.1.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R176. 


3.3.4.1.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 
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3.3.4.1.10.2.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

The  following  generic  parameters  were  previously  defined  with  this  part's 
specification. 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

1 

Description  | 

Unit  Vectors 

|  private 

1 

1 

One  dimensional,  three-element  array  of 

Sin  Cos  Ratio 

Sin_Cos_Ratio 

j  floating 
j  point  type 

Results  of  sine/cosine  operations 

Tan  Ratio 

j  floating 
j  point  type 

1 

1 

Results  of  tangent  operation 

Earth  Distances 

j  floating 

1 

Data  type  used  to  define  distance 

j  point  type 

1 

measurements  of  the  Earth's  radius 

Segment 

j  floating 

Data  type  used  to  define  distance 

Distances 

j  point  type 

1 

measurements  of  the  navigation  segments 

Data  objects: 

The  following  table  describes  the  generic  formal  objects  required  by  this  part: 


|  Name 

Type 

|  Value 

Description  | 

|  Earth  Radius 

1 

Earth_ 

Distances 

|  n/a 

1 

|  Radius  of  the  Earth  | 

1  1 

Subprograms: 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 


|  Name 

1  Type 

|  Description  | 

|  Dot  Product 

j 

1 

I 

|  function 
|  function 

|  Computes  the  dot  product  of  two  unit  vectors  | 
j  Multiplication  operator  defining  the  operation:  | 
j  Sin_Cos_Ratio  *  Earth_Distances  ■>  j 
j  Segment~Distances  j 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


CAMP  Software  Detailed  Design  Document 


Page  475 


|  Name 

1  Type  | 

Mode  |  Description 

1 

|  Unit 

|  Unit  Vectors  | 

in 

|  Unit  radial  vector  to  the  missile 

1 

j  Radial  M 

j  extending  outward  from  the  origin 

!  1 

|  of  the  Earth-centered  reference 

1 

I  1 

>  frame 

|  Unit 

|  Unit  Vectors  | 

in 

|  Segment  AB  unit  tangent  vector 

i 

|  Tangent  B 

1 

1 

3.3.4.1.10.2. 

4  LOCAL  DATA 

Data  objects: 

The  following  table  describes 

the  data  objects  maintained  by  this  part: 

|  Name  | 

Type  |  Value  | 

Description 

1 

|  Dot  Prod  | 

Sin  Cos  1  N/A 

1 

Due  to  the  geometry,  this  value  ends  up 

1 

j  Result  j 

Ratio  j 

1 

being  the  angle  between  UR_M  and  UR_B 

1 

3.3.4.1.10.2.5  PROCESS  CONTROL 


Not  applicable. 


3.3.4.1.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Waypoint_Steering) 
function  Distance_to  Current_Waypoint 

(Unit_Ra3ial_M  7  Unit_Vectors; 

Unit~Tangent_B  :  Unit~Vectors)  return  Segment_Distances  is 


—  — local  declarations- 


Dot  Prod  Result  :  Sin  Cos  Ratio; 


— begin  function  Distance_To_Current_Vaypoint- 


begin 

—  — dot  product  of  UR_M  and  UT_B,  because  of  the  geometry,  equals 

—  — the  angle  between  UR_M  and~UR  B 
Dot_Prod_Result  Dot_Product  iLeft  ■>  Unit_Radial_M, 

Right  ■>  Unit_Tangent_B) ; 
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return  Dot_Prod_Result  *  Earth_Radius; 
end  Distance_to_Current_Waypoint ; 


3.3.4.1.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 


None. 


3.3.4.1.10.2.8  LIMITATIONS 


None. 


3.3.4.1.10.3  COMPUTE  TURNING_AND_NONTURNING  DISTANCES (PROCEDURE  BODY)  UNIT  DESIGN 
(CATALOG  #PTll-0) 

This  part  computes  the  missile  turning  distance  projected  onto  the  current 
course  segment,  AB,  and  the  missile  nonturning  distance  measured  along  the  next 
course  segment,  BC. 


3.3.4.1.10.3.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R177. 


3.3.4.1.10.3.2  LOCAL  ENTITIES  DESIGN 
None. 


3.3.4.1.10.3.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

The  following  generic  parameters  were  previously  defined  when  this  part  was 
specified. 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name 

Type 

Description  | 

|  Distances 

floating 

Data  type  of  distance  measurements  | 

1 

point  type 

|  Tan  Ratio 

floating 

Data  type  of  results  of  tangent  operation  ' 

1 

point  type 

1 

Subprograms : 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 
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|  Name 

1  Type 

|  Description  | 

|  "*« 

1 

|  function 

1 

|  Multiplication  operator  defining  the  operation:  | 

|  Distances  *  Tan_Ratio  =■>  Distances 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


1 

Name 

1  Type 

Mode 

Description  | 

1 

Tan  of  One 

|  Tan  Ratio 

in 

Tangent  of  1/2  the  angle  between 

1 

Half  Turn 

current  course  segment  and  next  course 

1 

Angle 

segment 

1 

Segment  BC 

|  Distances 

in 

Great  circle  arc  length  between  way- 

1 

Distance 

points  B  and  C 

1 

Turn  Radius 

|  Distances 

in 

Desired  missile  turn  radius 

1 

Turning 

|  Distances 

out 

Distance  from  the  point  of  tangency  of 

1 

Distance 

1 

the  turn  circle  and  the  current  course 

1 

segment  AB  to  the  current  waypoint,  B 

1 

Nonturning_ 

|  Distances 

out 

Distance  from  the  point  of  tangency  of 

1 

Distance 

1 

the  turn  circle  and  the  next  course 

1 

1 

segment  BC  to  the  next  vaypoint,  C 

3.3.4.1.10.3.4  LOCAL  DATA 

Data  objects: 

The  following  table  describes 

the  data  objects  maintained  by  this  part: 

|  Name 

1  Type  | 

Value 

|  Description  | 

I  Temp  Turning 

|  Distances  | 

N/A 

|  Temporary  variable  | 

j  Distance 

1  1 

1  1 

3.3.4.1.10.3.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.1.10.3.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
separate  (Vaypoint_Steering) 

procedure  Corapute_Turning_and_Nonturning_Distances 

( Tan~o f _0ne_Ha  1  f _Tu rn_Angle~ :  in  Tan_Ratio; 

Segment  BC~Distance  :  in  Distances; 

Turn  Radius  :  in  Distances; 
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Turning  Distance 
Nonturning  Distance 


out  Distances; 
out  Distances)  is 


—  — declaration  section- 


Temp_Turning_Distance  :  Distances; 


— begin  procedure  Compute_Turning_And_Nonturning_Distances- 


begin 

Temp  Turning_Distance  :■  Turn_Radius  *  Tan_of_One_Half_Turn_Angle; 
Turning  Distance  :■  Temp_Turning  Distance; 

NonturnIng_Distance  Segment_BC_Dlstance  -  Temp_Turning_Distance; 
end  Compute_Turning_And  Nonturning_Distances; 


3.3.4.1.10.3.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3.3.4.1.10.3.8  LIMITATIONS 
None. 


3.3.4.1.10.4  DISTANCE  TOCURRENTVAYPOINTVITHARCSIN  (FUNCTION  BODY)  UNIT  DESIGN 
(CATALOG  #PlIl7-0) 

This  part  computes  the  distance  from  the  missile's  position  to  the  current 
waypoint,  B. 

It  does  not  use  the  assumption  that  alphasin(alpha)  when  doing  its 
computations. 

3.3.4.1.10.4.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R. 

3.3.4.1.10.4.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.4.1.10.4.3  INPUT/OUTPUT 


GENERIC  PARAMETERS: 
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The  following  generic  parameters  were  previously  defined  with  this  part's 
specification. 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name 

Type 

Description  | 

|  Unit_Vectors 

private 

One  dimensional,  three-element  array  of 

Sin  Cos  Ratio 

j  Radians 

1 

floating 
point  type 

Radian  units  of  angular  measurement 

|  Sin  Cos_Ratio 

floating 
point  type 

Results  of  sine/cosine  operations 

j  Tan_Ratio 

floating 
point  type 

Results  of  tangent  operation 

j  Earth  Distances 

floating 

Data  type  used  to  define  distance 

point  type 

measurements  of  the  Earth's  radius 

j  Segment 

floating 

Data  type  used  to  define  distance 

j  Distances 

point  type 

measurements  of  the  navigation  segments 

Data  objects: 

The  following  table  describes  the  generic  formal  objects  required  by  this  part: 


|  Name  | 

1  Type 

|  Value 

|  Description  | 

|  Earth  Radius  | 

|  Earth 

|  n/a 

[  Radius  of  the  Earth 

1  "  1 

|  Distances 

1 

1 

Subprograms : 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part : 


|  Name 

1  Type 

|  Description  | 

Dot  Product 

|  function 
j  function 

|  Computes  the  dot  product  of  two  unit  vectors  | 
j  Multiplication  operator  defining  the  operation:  1 
j  Radians  *  Earth_Distances  ->  Segment_Di stances  j 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 
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|  Name 

1  Type  | 

Mode  |  Description 

1 

|  Unit 

|  Unit  Vectors  | 

in 

|  Unit  radial  vector  to  the  missile 

1 

Radial  M 

extending  outward  from  the  origin 

1 

1 

!  1 

j  of  the  Earth-centered  reference 

1 

1 

1  1 

1  frame 

1 

j  Unit 

|  Unit  Vectors  j 

in 

j  Segment  AB  unit  tangent  vector 

1 

j  Tangent  B 

1 

1 

3.3.4.1.10.4.4 

LOCAL  DATA 

Data  objects: 

The  following 

table  describes 

the  data  objects  maintained  by  this  part: 

|  Name  | 

Type  |  Value  | 

Description 

1 

|  Dot  Prod  | 

Sin  Cos  1  N/A 

1 

Due  to  the  geometry,  this  value  ends  up 

I 

j  Result  ~  j 

Ratio  "  j 

1 

being  the  angle  between  UR  M  and  UR  B 

1 

3.3.4.1.10.4.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.1.10.4.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
separate  (Waypoint_Steering) 

function  Distance_to  Current_Waypoint_with_Arcsin 
(Unit_Ra3ial_M  :  Unit_VectorsJ 

Unlt_Tangent_B  :  Unit_Vectors)  return  Segment_Di stances  is 


—  — local  declarations- 


Dot  Prod  Result  :  Sin  Cos  Ratio; 


— begin  function  Distance_To_Current_Vaypoint- 


begin 

—  — dot  product  of  UR_M  and  UT_B,  because  of  the  geometry,  equals 

—  — the  angle  between  UR_M  and  UR  B 
Dot_Prod_Result  Dot~Product  TLeft  ->  Unit_Radial_M, 

Right  »>  Unit~Tangent_B); 
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return  Arcsin(Dot_Prod_Result)  *  Earth_Radius; 
end  Distance_to_Current_Waypoint_with_Arcsin; 

3.3.4.1.10.4.7  UTILIZATION  OF  OTHER  ELEMENTS 


None. 


3.3.4.1.10.4.8  LIMITATIONS 


None. 
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package  body  Waypoint_Steering  is 

package  body  Steering_Vector_Operations  is  separate; 

package  body  Steering_Vector_Operations_Vith_Arcsin  is  separate; 

procedure  Compu  te_Turn_Angle_And_Di  rec  t  i  on 

(Unit_Normal_C  "  :  in  Unit_Vectors; 

Unit_Tangent_B  :  in  Unit_Vectors; 

Unit_Tangent_C  :  in  Uni t_Vec tors; 

Tan_0f  One_Half_Turn_Angle  :  out  Tan_Ratio; 

Turn_Dlrection  -  :  out  Turning_Directions) 

is  separate; 

package  body  Crosstrack_And_Heading_Error_Operations  is  separate; 

function  Distance_To  Current_Waypoint 

(Unit_Ra3ial_M  T  Unit_Vectors; 

Unit_Tangent_B  s  Unit_Vectors) 
return  Segment_Distances  is  separate; 

function  Distance_To  Current_Waypoint_With_Arcsin 
(Unit_Ra3ial_M  :  Uni t_Vec torsi 
Unit_Tangent_B  :  Unit~Vectors) 
return  Segment  Distances  is  separate; 

procedure  Compu te  Turning  And_Nonturning_Di stances 

(Tan_Of_One_Half~Turn_Angle  :  in  Tan_Ratio; 

Segment  Bc_Distance  :  in  Distances; 

Turn  Radius  :  in  Distances; 

Turning  Distance  :  out  Distances; 

Nonturnlng  Distance  :  out  Distances)  is  separate; 

package  body  Turn_Test_Operations  is  separate; 


end  Vaypoint_Steering; 
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with  Geometric_Operations; 

separate  (Waypoint  Steering) 

package  body  SteerTng_Vector_Operations  is 

package  Geo  renames  Geometric_Operations; 


—  —  instantia'e  required  parts- 


function  U_R_Vector  is  new 

Geo . Uni t_Radial_Vector  (Indice?, 

Earth_Positions 
Sin_Cos_Ratio 
Unit  Vectors 


«>  Indices, 

«>  Earth_Positions, 
->  SinCosRatio, 

«>  Unit  Vectors); 


procedure  Compute_Segment_And  U_Nl_Vector  is  nev 

Geo. Compute  Segment  And  Unit  Normal  Vector 


(Indices 
Earth_Distances 
Segment_Distances 
Sin_Cos_Ratio 
Unit  Vectors 
EartE  Radius 


—  — local  declarations - 


UnitRadialB  s  Unit_Vectors; 
UnitRadialC  :  UnitVectors; 


—  — separate  procedures 


procedure  Initialize 

( Way po i n t_A_La t 
Way po i n  t_A_Long 
Waypoint~B_Lat 
Way po i n  t ~B~Long 
Vaypoint~C”Lat 
Way po in t~C~Long 
Uni  t_NoriaI_B 
Uni t~Normal_C 
Unit_Tangent_B 
Unit_Tangent  C 
Segmen t_Bc_Dls tance 

procedure  Update 

(Waypoint_C_Lat 
Waypoint_C~Long 
Uni t_NormaI_B 
Uni t_Normal_C 
Uni t~Tangent_B 
Unit "Tangent  C 
Segpnen  t_Bc_Dls  tance 


>>  Indices, 

->  Ear th_Di stances, 

=*>  Segmen t_Di stances, 
»>  Sin_Cos_Ratio, 

->  Unil  Vectors, 

->  EartE_Radius) ; 


in  Earth_Positions; 
in  Earth_Positions; 
in  Earth~Positions; 
in  Earth~Positions; 
in  Earth_Positions; 
in  Earth  Positions; 
out  Unit_Vectors; 
out  Uni t~Vec tors; 
out  Unit~Vectors; 
out  Uni t~Vec tors; 

out  Segment_Distances)  is  separate; 


in  Earth_Positions; 

in  Earth_Positions; 

out  Unit_Vectors; 
in  out  Uni t~Vec tors; 

out  Unit_Vectors; 
in  out  Uni t_Vec tors; 

out  Segment_Distances)  is  separate; 
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end  Steering_Vector_Operations; 
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separate  (Waypoint_Steering.Steering_Vector_Operations) 
procedure  Initialize 

(Waypoint_A_Lat  :  in  Earth_Positions; 

Waypoint_A_Long  :  in  Earth~Positions; 

Waypoint_B_Lat  :  in  Earth_Positions; 

Waypoint_B_Long  :  in  Earth_Positions; 

Waypoint_C_Lat  s  in  Earth~Positions; 

Waypoint_C  Long  :  in  Earth~Positions; 

Unit_NormaT_B  :  out  Unit_Vectors; 

Unit_Normal_C  s  out  Unit_Vectors; 

UnitJTangent_B  j  out  Unit_Vectors; 

Unit_Tangent  C  s  out  Uni t_Vec tors; 

Segment_Bc_Dlstance  s  out  Segment_Distances)  is 


—  —  declaration  section- 


Temp_Un_B  :  Unit_Vectors; 
Temp_Un  C  :  Unit_Vectors; 
Unit_Ra?ial_A  :  Unit_Vectors; 

V  Length  :  Sin  Cos_Ratio; 


—  begin  procedure  Initialize- 


begin 

—  —  compute  unit  radial  vectors 

Unit_Radial_A  :■  U_R_Vector(Lat_Of  Point  ->  VaypointALat , 

Long_0l  Point  ->  WaypointALong); 
Unit_Radial_B  :«  U_R_Vector(Lat_Of  Point  »>  Vaypoint_B_Lat , 

Long_Ol_Point  ->  Waypoint_B_Long) ; 
Unit_Radial_C  : -  U_R_Vector(Lat_Of  Point  ->  Waypoint_C~Lat , 

Long_Ol_Point  ■>  Waypoint  C  Long) ; 

—  — compute  i’N  B 

Temp  Un  B  Cross_Product(Lef t  ->  Unit_Radial_Bf 

Right  ->  Unit_Radial_A); 
V_Length  Vector_Length(Temp_Un_B) ;  ~ 

Temp_Un_B  :■  Temp_Un_B  /  V_LengTh; 

Unit_Normal_B  :  -  Temp_Un_B; 

—  — compute  UTB 

Unit  Tangent  B  Cross_Product(Left  ->  Temp_Un  B, 

Right  ->  Unit_Ra3ial_B) ; 

—  —  compute  UN  C  and  segment  BC  distance 

Compute_Segraent  And_U_Nl_Vector 

(Unit_RadialT  ~  «>  Uni t_Radial_B, 

Unit_Radial2  ■>  Unit_Radial_C, 

Unit_Normal2  »>  Temp_Un_Cf 
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Segment_Distance  =>  Segment_Bc_Distance) ; 

Uni  t_Normal_C  :=  Temp_Un_C; 

—  — compute  UT  C 

Unit_Tangent_C  :=  Cross_Product(Lef t  =>  Temp_Un  C, 

Right  =>  Unit-Ra3ial  C); 


end  Initialize; 
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separate  (Waypoint  Steering. Steering  Vector  Operations) 


procedure  Update 

(Waypoint_C_Lat 
Waypoint_C  Long 
Unit_NormaT_B 
Uni t_Normal_C 
Unit_Tangent_B 
Unit_Tangent  C 
Segment  Bc_Dlstance 

begin 


in  Earth_Positions; 

in  Earth_Positions; 

out  Unit_Vectors; 
in  out  Unit_Vectors; 

out  Unit_Vectors; 
in  out  Unit~Vectors; 

out  Segment_Di stances)  is 


—  — advance  "C"  vectors  into  "B"  vectors 


Unit_Radial_B  Unit_Radial_C; 

Uni t_Normal_B  :  -  Unit_Normal_C; 

Unit_Tangent_B  :  -  Unit_Tangent_C; 

—  —  calculate  new  values 

UnitRadialC  U_R_Vector(Lat_Of  Point  ->  Vaypoint_C_Lat, 

Long_OT_Point  »>  Waypoint_C_Long) ; 

Compute  Segment  And_U_Nl  Vector 

(Unit  RadialT  ->  Unit  Radial  B, 

Unit_Radial2  ->  Unit  Rad ial~C, 

Uni  t_Normal2  ->  Unit_Normal  C, 

Segment  Distance  ->  Segment_Bc_Cistance) ; 

Unit  Tangent  C  :  -  Cross_Product(Lef t  •>  Unit  Normal  C, 

Right  «>  Unit_Radial_C) ; 


end  Update; 
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separate  (Vaypoint_Steering) 
procedure  Compu t e_Turn_Angle_And_Di rec  t i on 
(Uni t_Normal_C  : 

Unit_Tangent_B  : 

Unit_Tangent_C  : 

Tan_0f  One_Half_Turn_Angle  : 
Turn  Direction  : 


in  Unit_Vectors; 

in  Uni t_Vec tors; 

in  Unit_Vectors; 

out  Tan_Ratio; 
out  Turning_Directions)  is 


—  —  declaration  section 


Tan  Of_Half  :  Tan_Ratio  renames  Tan_Of_One_Half_Turn_Angle; 


Cos_Of_Turn_Angle  s  Sin_Cos_Ratio; 
Sin  Of  Turn  Angle  :  Sin  Cos  Ratio; 


—  begin  procedure  Compute  Turn  Angle  and  Direction- 


begin 

Cos  Of  Turn  Angle  :«  Dot_Product(L«f t  ->  Unit_Tangent_B, 

Right  ■>  Unit_Tangent_C); 

Sin  Of  Turn  Angle  :«  Dot  Product(Left  ■>  Unit_Tangent  B, 

Right  »>  Unit_Nor«al_C); 

Tan_Of_Half  s-  aba(Sin_Of_Turn_Angle  / 

(TanRatio(l.O)  +  Cos_Of_Turn_Angle)); 

if  Sin_Of  Turn  Angle  <  0.0  then 
Turn_DlrectIon  s-  Left_Turn; 
else 

Turn_Di  recti  on  Right_Turn; 

end  if; 

end  Compu te_Turn_Angle_And_Di rec t ion ; 
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separate  (Waypoint_Steering) 

package  body  Cross track_And  Heading_Error_Operations  is 


procedure  Compute_When_Turning 
(Distance_To_B 
Nonturning  Distance 
Unit_RadiaI_M 
Unit_Normal_B 
Unit_Tangent_B 
Turn_Direction 
Ground_Veloci ty 
Turn_Radius 
Cross  t  rack_Er ror 
HeadingError 


in  Segment_Distances; 
in  Segment_Distances; 
in  Unit_Vectors; 
in  Unit_Vectors; 
in  Unit  Vectors; 
in  TurnIng_Directions; 
in  Velocity_Vectors; 
in  SegmentjDistances; 
out  Segment_Distances; 
out  Angles)  is  separate; 


procedure  Compute_Vhen  Not  Turning 

(Unit_RadIal_H  :  in  Unit_Vectors; 
Unit_Normal_B  :  in  Unit  Vectors; 
Ground_Veloci ty  :  in  Velocity  Vectors; 
Crosstrack_Error  :  out  Segment_Di stances; 
Heading_Error  :  out  Angles )~is  separate; 


procedure  Compute 

(DistanceTo  B  : 
Nonturning  Distance  : 
UnitRadialM  : 
Uni t_Normal_B  s 
Unit_Tangent_B  : 
TurnDirection  i 
Turn_Status  s 
Ground_Velocity  : 
Turn_Radius  s 
Cross track_Error  : 
Heading_Error  s 


in  SegmentjDistances; 
in  Segment_Distances; 
in  Uni t_Vec tors; 
in  Uni t_Vec tors; 
in  Unit  Vectors; 
in  Turning jDirec  t ions ; 
in  Turning~Statuses; 
in  Velocity  Vectors; 
in  Segment_Sistances; 
out  Segment_Distances; 
out  Angles)  is  separate; 


end  Cross track_And_Heading_Error_Operations; 
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separate  ( Waypoin t_Steering. Cross track_And_Heading_Error_Operat ions) 


procedure  Compute_When  Turning 
(Distance~To_B 
Nonturning  Distance 
Unit_RadiaI_M 
Unit_Normal~B 
Uni t_TangenI_B 
Turn-Direction 
Ground_Velocity 
Turn_Radius 
Cross track_Error 
Heading_Error 


in  Segment_Distances; 
in  Segment_Distances; 
in  Unit_Vectors; 
in  Unit_Vectors; 
in  Unit~Vectors; 
in  TurnIng_Directions; 
in  Velocity_Vectors; 
in  Segmen t_Distances; 
out  Segmen t~Distances; 
out  Angles)  is 


—  — declaration  section- 


Cross track  Distance 

D_Y 

D_X 

D  H_D_C 
Direction 
Do  t_Prod_Resul t 
N_H_D_C 
RM  ‘ 


Segmen t_Di stances; 
Segment_Distances; 
Segmen  t_Di  s  tanc.es ; 
Segmen  t  JD  i s  t ances ; 
INTEGER; 
Sin_Cos_Ratio; 
Segmen  t_Di s  t ances ; 
Segmen t~Distances ; 


—  begin  procedure  Compute  When  Turning- 


begin 

—  —  convert  turn  direction  to  an  integer  value 

if  Turn_Direction  *  Left_Turn  then 
Direction  :=  -1; 
else 

Direction  1; 
end  if; 

—  — get  the  sine  of  the  angle  (which  approximately  equals  the  angle) 

—  —  between  the  actual  and  desired  UR_M, 

—  — and  then  compute  crosstrack  distance 

Dot_Prod_Result  : »  Dot_Product  (Left  ■>  Unit_Radial_M, 

Right  »>  Unit  Normal_B); 

Cross track_Di stance  Dot_Prod_Result  *  Earth_Ra3ius; 

—  —  compute  the  radius  of  the  circle  that  the  missile  is  actually  traversing 

D_Y  :=  Turn_Radius  -  Cross track_Di stance  *  Direction; 

D_X  :»  Distance_To  B  -  Nonturning  Distance; 

R_M  Sqrt(D_X  *  D_X  +  D_Y  *  D_Yj; 

—  —  compute  crosstrack  error 

Cross track_Error  :■  (Turn_Radius  -  R_M)  *  Direction; 
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—  —  compute  heading  error 

N_H_D_C  :=  Direction  *  Unit_Tangent  B(Z)  *  D  X  - 
Uni t_Normal_B(Z)  *  D_Y; 

D_H_D_C  :  =  -Direction  *  Unit_Normal_B(Z)  *  D_X  - 
Unit  Tangent_B(Z)  *  D_Y; 

Heading_Error  :=  Arctan((N_H_D_C  *  Ground_Velocity(N)  - 

D_H~D_C  *  Ground_Velocity(E))  / 
(D_H_D_C  *  Ground_Velocity(N)  + 
N_H~D~C  *  Ground_Velocity(E))); 

end  Compute_When_Turning; 
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separate  (Waypoint_Steering. Cross track_And_Heading_Error_Operat ions) 
procedure  Compute_When  Not  Turning 

(Unit_RadTal_M  :  in  Unit  Vectors; 

Unit_Normal_B  :  in  Unit~Vectors; 

Ground_Velocity  :  in  Velocity_Vectors; 

Cross track_Error  :  out  Segment_Distances; 

Heading_Error  :  out  Angles)  is 


—  —  local  declarations- 


Dot_Prod_Result  :  Sin_Cos_Ratio; 
D_H_D_C  :  Sin_Cos_Ratio; 
N  H  D  C  :  Sin-Cos  Ratio; 


—  begin  procedure  Compute  When  NotTuming- 


begin 

—  — get  the  sine  of  the  angle  ( which  approximately  equals  the  angle ) 

—  —  between  the  actual  and  desired  UR  M, 

—  — and  then  compute  crosstrack  distance/error 


Dot_Prod_Result  s-  Dot_Product  (Left  ->  Uni tRadialM, 

Right  ->  Unit  NormalB); 

Cross trackError  Dot_Prod_Result  *  Earth_Ra3ius; 

—  — compute  heading  error 

N_H_D_C  s-  -  Unit  Normal  B(Z)j 
D_H_D_C  Uni t_Normal  B?Y)  *  Unit_Radial  M(X)  - 
Unit_Normal~B(X)  *  Unit_Radial”M(Y); 

Heading_Error  Arctan((N  H  D_C  *  Ground  Velocity (N)  - 

D~B~D_C  *  Ground“Velocity(E))  / 
(D_H_D_C  *  Ground~Veloci ty (N)  + 
N_H~D~C  *  Ground~Veloci  ty (E)  )  ) ; 

end  Compute_When_Not_Turning; 
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separate  ( Waypoin t_Steering. Cross track_And_Heading_Error_Operat ions) 
procedure  Compute 

(Distance_To_B  s  in  Segment_Distances; 

Nonturning  Distance  :  in  Segment_Distances; 

Unit_RadiaI_M  :  in  Uni t_Vectors; 

Unit_Normal_B  :  in  Uni t_Vectors; 

Unit_Tangent_B  :  in  Unit  Vectors; 

Turn_Direction  :  in  TurnIng_Directions; 

Turn_Status  s  in  Turning_Statuses; 

Ground_Velocity  :  in  Velocity_Vectors; 

Turn_Radius  :  in  Segment_Di stances; 

Cross track_Error  :  out  Segment~Di stances; 

Heading_Error  :  out  Angles)  is 

begin 

if  Turn_Status  »  Turning  then 
Compu  t  e_Vhen_Turn i ng 

(Distance_To  B  ■>  Distance_To  B  , 

Non turning  Distance  ->  Nonturning  Distance  , 

Uni t_RadiaI_M  ->  Unit_RadiaI_M  , 

Unit_Normal_B  ->  Unit~Normal_B  , 

Unit_Tangent_B  =»>  Unit~Tangent_B  , 

Turn_Direction  ■>  Turn~Direction  , 

Ground_Velocity  ->  Ground_Velocity  , 

Turn_Radius  ->  Turn_Radius  , 

Cross track_Err or  »>  Cross trackError  , 

HeadingError  »>  Heading_Error  ); 

else 

Compute_tfhen_Not  Turning 

( UnT t_Radial_M  ->  Unit_Radial_M 
Unit  Normal  B  ->  Uni  t_Normal_B  , 
Ground_Velocity  ->  Ground_Velocity  , 

Cross track_Error  ->  Cross track_Error  , 
Heading_Error  ->  HeadingError  ); 

end  if; 
end  Compute; 
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separate  (Waypoint_Steering) 
function  Distance_To  Current_Waypoint 

(Unit_Ra3ial_M  :  Unit_Vectors; 

Unit_Tangent_B  :  Unit_Vectors)  return  Segment_Distances  is 


—  —  local  declarations- 


Dot  Prod  Result  :  Sin  Cos  Ratio; 


—  begin  function  Distance  To  Current  Waypoint- 


begin 

—  —  dot  product  of  UR_M  and  UT_B,  because  of  the  geometry,  equals 

—  —  the  angle  between  URM  and  URB 

Dot_Prod_Result  Dot_Product  (Left  ->  Unit_Radial_M, 

Right  ->  Unit_Tangent_B); 

return  Dot  Prod_Result  *  Earth_Radius; 
end  DistanceJfo_Current_Vay point; 
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separate  (Waypoint_S tee ring) 

procedure  Compu t e_Turn i ng_And_Non t urn i ng_Di stances 
(Tan_Of_One_Half_Turn_Angle  :  in 


Segment  Bc_Distance  :  in 

Turn  Radius  :  in 

Turning  Distance  :  out 

NonturnIng_Distance  :  out 


Tan_Ratio; 
Distances; 
Distances; 
Distances; 
Distances)  is 


—  —  declaration  section- 


Temp_Turning_Distance  :  Distances; 


— begin  procedure  Compute  Turning  And  Nontuming  Distances- 


begin 

Temp  Turning_Distance  : »  Turn_Radius  *  Tan_Of_One_Half_Turn_Angle; 
Turning  Distance  :»  Temp_Turning  Distance; 

NonturnIng_Distance  u  Segment_Bc_Dlstance  -  Temp_Turning_Distance; 

end  Compute_Turning_And_Nonturning_Dis  tances ; 
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separate  (Waypoint_Steering) 
package  body  Turn_Test_Operations  is 

function  Stop_Test 

(Distance_To_B  :  Distances; 

Nonturning_Distance  :  Distances; 

Lead_Distance  :  Distances) 

return  Turning_Statuses  is  separate; 

function  Start  Test 

(Dlstance_To_B  :  Distances; 

Turning_Distance  :  Distances; 

Lead_Distance  :  Distances) 

return  Turning_Statuses  is  separate; 

end  Turn_Test_Operations; 
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separate  (Waypoint_Steering.Turn_Test_Operations) 
function  Stop_Test 

(Distance_To_B  :  Distances; 

Nonturning_Distance  :  Distances; 

Lead_Distance  :  Distances)  return  Turning_Statuses  is 


—  —  declaration  section- 


Turn_Status  :  Turning_Statuses  s«  Turning; 


—  begin  function  Stop  Test- 


begin 

if  Distance_To_B  <-  (Lead_Di stance  +  Nonturning_Distance)  then 
Turn_Status  Not  Turning; 
end  if; 

return  Turn  Status; 


end  Stop_Test; 
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separate  (Waypoint_Steering.Turn_Test_Operations) 
function  Start  Test 

(Dlstance_To_B  ;  Distances; 

Turning_Di stance  :  Distances; 

LeadDistance  :  Distances)  return  Turning  Statuses  is 


—  —  declaration  section- 


Turn_Status  :  Turning_Statuses  Not_Turning; 


—  begin  function  Start  Test- 


begin 

if  Distance_To_B  <«  (Lead_Di stance  +  Turning_Distance)  then 
Turn_Status  Turning; 
end  if; 

return  Turn  Status; 


end  Start  Test; 
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with  Geometric_Operations; 
separate  (Waypoint  Steering) 

package  body  SteerIng_Vector_OperationsJfith_Arcsin  is 
package  Geo  renames  Geometric_Operations; 


—  —  instantiate  required  parts- 


function  U_R_Vector  is  nev 

Geo.Unit_Radial_Vector  (Indices 

Ear th_Posit ions 
Sin_Cos_Ratio 
Unit  Vectors 


■>  Indices, 

->  Earth_Positions, 
■>  Sin_Cos_Ratio, 

■>  Unit  Vectors); 


procedure  Compute_Segment_And_U_Nl_Vector  is  new 

Geo. Compute  SegmenI  And  Unit  Normal  Vector  Vith  Arcsin 


(Indices 
Earth_Distances 
Segmen  t_D i s  t ances 
Radians 
Sin_Cos_Ratio 
Unit  Vectors 
EartH  Radius 


»>  Indices, 

«>  Earth_Distances, 

«>  Segment_Distances, 
=•>  Radians, 

->  Sin_Cos_Ratio, 

■>  UniT  Vectors, 

->  EartH  Radius); 


—  —  local  declarations - 


Unit_Radial_B  s  UnitVectors; 
Unit  Radial  C  :  Unit  Vectors; 


pragma  PAGE; 

procedure  Initialize 

( Way po i n t_A_La t 
Way po i n  t_A_Long 
Waypoint~B~Lat 
Way po i n  t~B_Long 
Waypoint~C~Lat 
Waypoint_C  Long 
Uni t_NormaI_B 
Unit~Normal~C 
Unit~Tangent_B 
Unit "Tangent  C 
Tegment  Be  Distance 


in  Earth_Positions; 
in  Earth_Positions; 
in  EarthJPositions; 
in  Earth~Positions; 
in  Earth~Positions; 
in  Earth~Positions; 
out  Uni t_?ec tors; 
out  Uni t~Vec tors; 
out  Uni t_Vec tors; 
out  Uni t_Vec tors; 
out  Segment_Distances)  is 


—  declaration  section- 


Temp_Un_B  :  Unit_Vectors; 
Temp_Un~C  :  Unit_Vectors; 
Unit_Ratfial_A  s  Unit  Vectors; 
V_Leiigth  ~  s  Sin_Cos_Ratio; 
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—  begin  procedure  Initialize- 


begin 


—  compute  unit  radial  vectors 


Unit_Radial_A  :=  U_R_Vector(Lat_0f  Point 

Long_0l_Point 

Unit_Radial_B  :=  U_R_Vector(Lat_0f  Point 

Long_Ol_Point 

Unit_Radial_C  U_R_Vector(Lat_Of  Point 

Long_Ol_Point 


=>  Waypoint_A_Lat, 

->  Waypoint_A_Long); 
»>  Vaypoint_B_Lat, 

■>  Waypoint_B_Long); 
->  Waypoint_C_Lat, 

->  Waypoint_C_Long); 


—  compute  UN  B 


Temp_Un_B 

V_Length 
Temp_Un_B 
Unit  Normal  B 


:■  Cross_Product(Left  ->  Unit_Radial_B, 
Right  ■>  Unit_Radial_A) ; 
Vector_Length(Temp_Un_B)> 

Temp_Un_B  /  V_Length;“ 

: -  Temp_Un_B; 


—  compute  UTB 


Unit_Tangent_B  :■  Cross_Product(Left  ->  Temp_Un  B, 

Right  ->  Unit_Ra3ial_B); 


—  compute  UN  C  and  segment  BC  distance 

ComputeSegment  And  U  Nl  Vector 

(Unit_RadialI  ->  Unit_Radial_B, 

Unit_Radial2  ->  Uni t~Radial~C, 

Unit_Normal2  «>  Temp_Un_C, 

Segment_Distance  ->  Segment_Bc_Distance) ; 

Uni t_Normal_C  : -  Temp_Un_C; 

—  compute  UT  C 


UnitTangentC  :*  Cross_Product(Left  ■>  Temp_Un  C, 

Right  ■>  Unit_Ra<Iial_C); 


end  Initialize; 


pragna  PAGE; 

procedure  Update 


(Vaypoint_C_Lat 

in 

Vaypoint_C  Long 

in 

Uni t_NormaI_B 

out 

Unit_Normal_C 

in  out 

Unit_Tangent_B 

out 

Unit_Tangent  C 

in  out 

Segmen  t_Bc_  Dls  t ance 

out 

begin 


Earth_Positions; 

Earth  Positions; 

Unit_7ectors; 

Unit~Vectors; 

Unit_Vectors; 

Unit_Vectors; 

Segment_Di stances)  is 


— advance  "C"  vectors  into  "B"  vectors 
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Unit_Radial_B  Unit_Radial_C; 

Unit_Normal_B  :=  Uni t_Normal_C; 

Uni t_Tangen t_B  :=  Uni t_Tangent_C; 

—  calculate  new  values 

Unit_Radial_C  :=  U_R_Vector(Lat_0f  Point  =>  Vaypoint_C_Lat, 

Long_0l_Point  ■>  Waypoint_C_Long) ; 

Compute_Segment  And_U_Nl  Vector 

(UnitRadiall  ->  Unit_Radial_B, 

Unit_Radial2  ->  Unit_Radial_C, 

Unit_Normal2  »>  Unit_Normal_C, 

SegmentDistance  ■>  Segment_Bc_Distance); 

Unit_Tangent_C  s-  Cross_Product(Left  ->  Unit_Normal_C, 

Right  ->  Unit_Radial_C); 


end  Update; 

end  Steering_Vector_Operations_Vith_Arcsin; 
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separate  (Waypoint_Steering) 

function  Distancejfo  Current_Waypoint_Vith  Arcsin 
(Unit_Ra3ial_M  :  Unit_Vectors7 

Unit_Tangent_B  :  Unit  Vectors)  return  Segment_Distances  is 


—  — local  declaralions- 


Dot  Prod  Result  :  Sin  Cos  Ratio; 


—  begin  function  Distance  Jo  Curr...._Waypoint- 


begin 

—  —  dot  product  of  UR  M  and  UT_B,  because  of  the  geometry,  equals 

—  —  the  angle  between  UR  M  and  UR  B 

Dot_Prod_Result  Dot_Product  (Left  ■>  Unit  Radial_M, 

Right  ■>  UnitJTangentB); 

return  Arcsin(Dot_Prod_Result)  *  Earth_Radius; 

end  Distance_To_Current_tfaypoint_With_Arcsin; 
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3. 3. 4. 2  AUTOPILOT  (PACKAGE  BODY)  TLCSC  (CATALOG  #P305-0) 

This  package  body  contains  bodies  for  the  the  three  packages  nested  in  the 
Autopilot  package.  Each  of  these  packages  is  separately  compiled. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 

3. 3. 4. 2.1  REQUIREMENTS  ALLOCATION 

This  part  meets  the  following  CAMP  requirements. 


Name 

1 

Type 

|  Req.  Allocation  | 

Integral  Plus  Proportional 

7 

generic  package 

|  R048  | 

Pitch  autopilot 

i 

generic  package 

|  R059 

Lateral/Directional  autopilot 

i 

i 

generic  package 

1  R064  | 

3. 3. 4. 2. 2  LOCAL  ENTITIES  DESIGN 
None. 

3. 3. 4. 2. 3  INPUT/OUTPUT 
None. 

3. 3. 4. 2. 4  LOCAL  DATA 
None. 

3. 3. 4. 2. 5  PROCESS  CONTROL 
Not  applicable. 

3. 3. 4. 2. 6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
package  body  Autopilot  is 

package  body  Integral_Plus_Proportional_Gain  is  separate; 

package  body  Pitch_Autopilot  is  separate; 

package  body  Lateral_Directional_Autopilot  is  separate; 
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end  Autopilot; 


3. 3. 4. 2. 7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3. 3. 4. 2. 8  LIMITATIONS 
None. 

3. 3. 4. 2. 9  LLCSC  DESIGN 

3. 3. 4. 2. 9.1  INTEGRAL_PLUS_PROPORTIONAL_GAIN  (PACKAGE  BODY)  PACKAGE  DESIGN  (CATALOG 
#P306-0) 

This  part  contains  subprograms  to  implement  the  calculations  and  logic 
necessary  to  implement  an  integral  plus  proportional  gain  control  loop.  It 
also  contains  a  subprogram  to  update  the  value  for  the  proportional  gain. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 4. 2. 9. 1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R048. 


3. 3. 4. 2. 9. 1.2  LOCAL  ENTITIES  DESIGN 
None. 


3. 3. 4. 2. 9. 1.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name  | 

Type 

|  Description  | 

|  Input_Signals  | 
j  Gains  ! 
j  Integrated  Signals | 

1  "  1 

generic  float 
generic  float 
generic  float 

|  Type  of  values  input  to  part 
j  Type  of  gain  applied  to  input 
|  Input  signal  put  through 
j  integrator 

Data  objects: 
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The  following  table  describes  the  generic  formal  objects  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Initial 

j  ProportIonal_Gain 

Gains 

|  Initial  value  of  proportional  gain  | 
applied  to  input  signal  j 

Subprograms: 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 


|  Name  | 

Type  | 

Description  | 

1  1 

|  Tustin_  | 

j  Integrate! 

function  | 

1 

function  | 

1 

Overloads  Input_Signals  *  Gains  return  i 

Integrated  Signals  for  proportional  gainj 
Performs  Tustin  integrator  vith  limit  * 

1 

3. 3. 4. 2. 9. 1.4 

LOCAL  DATA 

Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

Type 

|  Description  | 

|  Proportional_Gain 

Gains 

|  Gain  applied  to  input  signal.  | 

3. 3. 4. 2. 9. 1.5  PROCESS  CONTROL 
Not  applicable. 

3. 3. 4. 2. 9. 1.6  PROCESSING 

The  following  describes  the  pj.y  *ssing  performed  by  this  part: 
separate  (Autopilot) 

package  body  Integral_Plus_Proportional_Gain  is 

Proportional_Gain:  Gains  :*  Initial_Proportional_Gain; 
end  Integral_Plus_Proportional_Gain; 
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3. 3. 4. 2. 9. 1.7  UTILIZATION  OF  OTHER  ELEMENTS 


None. 


3. 3. 4. 2. 9. 1.8  LIMITATIONS 


None. 


3. 3. 4. 2. 9. 1.9  LLCSC  DESIGN 


None. 


3.3.4.2.9.1.10  UNIT  DESIGN 

3.3.4.2.9.1.10.1  INTEGRATE  UNIT  DESIGN 

This  function  performs  the  integral  plus  proportional  gain  function.  The  logic 
to  perform  this  operation  is  as  follows: 

Accept  new  input  signal  Use  Tustin  Integrator  with  Limit  to  adjust  input  signal 
(If  Integrator  state  within  limit  do  not  change  input.  If  Integrator  state  at 
positive  limit  and  input  signal  >  0  then  set  input  to  0.  If  Integrator  state 
at  negative  limit  and  input  signal  <  0  then  set  input  to  0.)  Use  Tustin 
Integrator  to  perform  integration  and  limit  functions.  Output  -  Proportional- 
Gain  *  input  signal  -i-  Tustin  Integrator  State. 


3.3.4.2.9.1.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R048  (2). 


3.3.4.2.9.1.10.1.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.1.10.1.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Signal 

1 

|  Input  Signals 

1 

Value  of  Input  Signal  for  integral  | 
plus  proportional  gain. 
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3.3.4.2.9.1.10.1.4  LOCAL  DATA 


None. 


3.3.4.2.9.1.10.1.5  PROCESS  CONTROL 
Not  applicable. 

3.3.4.2.9.1.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  Integrate  (Signal:  Input_Signals)  return  IntegratedSignals  is 
begin 

return  (Tustin_Integrate  (Signal)  +  Signal  *  Proportional_Gain) ; 
end  Integrate; 


3.3.4.2.9.1.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top-level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsevhere  in  the  parent  top-level  component: 


|  Name 

Type 

Source 

Description  | 

"*« 

function 

Generic 
Fml  Subp 

Overloads  Input_Signals  *  Gains 
return  Integra!ed_Signals  for 
proportional  gain  ” 

Tustin 

function 

Generic 

Performs  Tustin  integrator  with 

Integrate 

Fml  Subp 

limit 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined 
elsewhere  in  the  parent  top-level  component: 
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1 

Name  | 

Type  | 

Source  | 

Description  | 

1 

Input  Signals  ! 

generic | 

Generic  j 

Type  of  values  input  to  part  | 

float  | 

fml  typej 

1 

1 

Gains  ! 

generic  j 

Generic  j 

Type  of  gain  applied  to  input | 

1 

float  | 

fml  typej 

1 

1 

Integrated  Signals | 

generic  j 

Generic  j 

Input  signal  put  through  | 

I 

float  j 

fml  type| 

integrator  j 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

Type 

Source 

Description  | 

|  Proportional  Gain 

1 

Gains 

Package  Body 

Gain  applied  to  input 
signal  j 

3.3.4.2.9.1.10.1.8  LIMITATIONS 


None. 


3.3.4.2.9.1.10.2  UPDATE_PROPORTIONAL_GAIN  UNIT  DESIGN 

This  procedure  updates  the  value  stored  for  the  proportional  gain. 


3.3.4.2.9.1.10.2.1  REQUIREMENTS  ALLOCATION 
This 'part  meets  CAMP  requirement  R048. 


3.3.4.2.9.1.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.1.10.2.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 
Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 
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|  Name 

1  Type 

|  Description  | 

|  Gains 

|  generic 

float  |  Type  of  gain  applied  to  input  | 

FORMAL  PARAMETERS: 

The  following  table 

summarizes 

the  formal  parameters  required  by  this 

|  Name 

1  Type  | 

Description  | 

|  New_Proportional_ 
j  Gain 

|  Gains  | 

1  1 

Value  to  update  proportional  gain 

3.3.4.2.9.1.10.2.4  LOCAL  DATA 
None. 

3.3.4.2.9.1.10.2.5  PROCESS  CONTROL 
Not  applicable. 

3.3.4.2.9.1.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Proportional_Gain  (New_Proportional_Gain  :  in  Gains)  is 
begin 

Proportional_Gain  :■  New  Proportional  Gain; 
end  Update_Proportional_Gain; 

3.3.4.2.9.1.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

Type 

Source 

Description  | 

|  Proportional  Gain 

1 

Gains 

Package  Body 

Gain  applied  to  input 
signal 

1) 
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3.3.4.2.9.1.10.2.8  LIMITATIONS 


None. 


3. 3. 4. 2. 9. 2  LATERAL  DIRECTIONAL  AUTOPILOT  (PACKAGE  BODY)  PACKAGE  DESIGN  (CATALOG 
#P308-0) 

This  package  body  implements  the  Lateral  Directional  Autopilot  function.  It 
contains  the  instantiation  of  the  Integral  Plus  Proportional  Gain  packages  for 
the  integrator  loops  of  both  the  Roll  Command  Error  and  the  Lateral 
Acceleration  feedback,  as  veil  as  subprogram  bodies  for  operations  declared  in 
the  package  specification. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 4. 2. 9. 2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 


3. 3. 4. 2. 9. 2. 2  LOCAL  ENTITIES  DESIGN 


Packages : 

Instantiates  Integral  plus  proportional  gain  package  for  aileron  roll  command 
and  for  filtered  lateral  directional  acceleration.  Also  instantiates  Tustin 
integrator  to  implement  each  of  the  integral  plus  proportional  gain  packages. 


3. 3. 4. 2. 9. 2. 3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 
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|  Name  |  Type  |  Description  | 


|  Roll_Commands 

|  Generic 

Float 

Type  for  input  commands 
from  user  program 

|  Roll_Attitudes 

|  Generic 

1 

Float 

Type  for  measure  missile 
roll  attitude 

j  Roll  Command  Gains 

1  Generic 

1 

Float 

Gain  to  Roll  commands 
in  integrator  loop 

j  Missile_Accelerations 

|  Generic 

1 

Float 

Type  for  measured  lateral 
acceleration 

j  Acceleration_Gains 

|  Generic 

Float 

Proportion&l  gain  applied 
measured  acceleration 

|  Rudder  Cmd  Roll  Rate_ 
j  Gains 

|  Generic 

1 

Float 

Gain  applied  to  roll  rate 
feedback  for  rudder  cmd 

j  Gravitational_ 
j  Accelerations 

j  Generic 

Float 

Type  for  measured  gravi¬ 
tational  acceleration 

j  Velocities 

|  Generic 

Float 

Type  for  measured  missile 
velocity 

j  Trig_Value 

|  Generic 

1 

Float 

Type  for  result  of  sin 
function 

|  Fin  Deflections 

j  Generic 

Float 

Type  for  rudder  and 
aileron  commands 

j  Feedback_Rates 

j  Generic 

1 

Float 

Type  for  measured  roll 
and  yav  rates 

|  Feedback_Rate_Gains 

|  Generic 

1 

Float 

Gain  applied  to  yav  rate 
feedback 

Data  objects: 

The  following  table  summarizes  the  generic  formal  objects  required  by  this 
part: 
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|  Name  |  Type  |  Description 


Initial_Aileron 
Integrator_GaTn 
Ini t ial_Ai leron_ 
Integrator_Limit 
Ini t ial_Roll_Command 
Proport ional_Gain 

Initial_Roll  Rate_ 
Gain  For_Alleron 
Ini t i aI_Yaw_Ra  t  e_ 
Gain  For  Aileron 
Ini  t  iaI_Ru<Ider_ 
Integrator_Gain 
Initial_Rudder 
Integrator_LTmit 
Ini tial_Yaw_Rate_ 
Gain  For  Rudder 
In i t i aI_RoIl_Ra  t  e_ 
Gain  For_Rudder 
Ini t iaI_Accelera  t ion 
Proport ional_Gain 


Rol l_Command_Ga i ns 
Fin_Deflections 
Roll  Command  Gains 


Feedback_Rate_ 

Gains 

Feedback_Rate_ 

Gains 

Acceleration_ 

Gains 

FinJDeflections 

Feedback_Rate_ 

Gains 

Rudde  r _Cmd_Ro 1 1_ 
Rate~Gains 
Acceleration  Gains 


Gain  used  to  initialize! 

aileron  loop  j 

Initial  limit  on  ailer-j 
on  integrator  output  \ 
Gain  used  to  initialize] 
integrator  plus  pro¬ 
portional  gain  loop 
Gain  to  measured  roll 
rate  for  aileron  cmd 
Gain  to  measured  yaw 
rate  for  aileron  cmd 
Initial  gain  in  rudder 
integrator  loop 
Initial  limit  on  rudder 
integrator  output 
Gain  to  measured  yaw 
for  rudder  command 
Gain  to  measured  roll 
rate  for  rudder  cmd 
Initial  Prop,  gain  in 
integrator  plus  pro¬ 
portional  gain  loop 


Subprograms : 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 
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Name  |  Type  |  Description 


Aileron  control  loop  limiters  and  filters  | 


Roll_Error_Limit  |  function  |  Limiter  for  roll  error  j 

Aileron_Command_Limit  |  function  j  Limit  on  command  signal  to  i 

j  |  aileron  t 

Roll_Command_Filter  j  function  j  Filter  applied  to  input  roll 

j  command  | 


Rudder  control  loop  limiters,  filters,  and  operations  i 


Rudder_Command_Limi t 

Yaw  Rate  Filter 

Acceleration_Filter 

Sin 

|  function  | 

1 

|  function  | 

1 

|  function  | 

1  1 

|  function  | 

1  1 

Limit  on  command  signal  to 
rudder 

Filter  applied  to  measured 
yaw  rate 

Filter  applied  to  measured 
acceleration  feedback 

Sin  function  applied  to 
measured  roll  attitude 

Aileron  control  loop  gain  and  updater  functions 

w_n 

|  function  | 

1  .  1 

Subtracts  Roll_Attitudes  from 
RollCommands  returning  Roll_ 
Brror  ~ 

j  function  j 
i  1 

1  1 

Multiplies  Roll  Commands  by 
Roll_Command_Sains  for 
input  to  Aileron  integrator 

|  function  | 

1  i 

Multiplies  FeedbackRates  for 
measured  roll  rate  by 

FeedbackRate_Gains 
for  Fin  Deflections 


Rudder  control  loop  gain  and  updater  functions 


if  /n 


|  function 


j  function 
|  function 


j  function 


Multiplies  Missile_Accelera- 
tions  by  Acceleration_Gains 
returns  Fin  Deflections  for 
proportional  loop  of  int¬ 
egral  plus  proportional  gain 
Multiplies  Feedback_Rates  by 
Rudder_Cmd_Roll  Rate_Gains 
returns  FeedbacK_Rates 
Multiplies  Gravitational 
Accelerations  by  Trig_Value 
returns  Gravitational' 
accelerations 
Divides  Gravitational 

Accelerations  by  Velocities 
returns  Feedback  Rates 
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3. 3. 4. 2. 9. 2. 4  LOCAL  DATA 


Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name  |  Type  |  Description  | 

|  Objects  for  Aileron  Control  Loop  | 


|  Aileron_Cmd_Roll 
j  Rate_Gain 
|  Aileron_Cmd_Yaw_ 
j  Rate_Gain 


|  Feedback_Rate_Gains  |  Gain  on  roll  rate  feedback  | 
j  j  in  aileron  command  loop  j 
j  Feedback_Rate_Gains  |  Gain  on  yaw  rate  feedback  j 
!  j  in  aileron  command  loop  j 


|  Objects  for  rudder  control  loop 


|  Rudder_Cmd_Roll_  |  Rudder_Cmd_Roll 

!  Rate_Gain  j  Rate_Gains 

j  Rudder_Cmd_Feedback_ j  Feedback_Rate_Gains 

j  Rate_Gain  j 


Gain  to  roll  rate  feedback | 
in  rudder  command  loop  j 
Gain  to  yaw  rate  feedback  j 
in  rudder  command  loop 


3. 3. 4. 2. 9. 2. 5  PROCESS  CONTROL 


Not  applicable. 


3. 3. 4. 2. 9. 2. 6  PROCESSING 


The  following  describes  the  processing  performed  by  this  part: 

with  Signal_Processing; 
separate  (Autopilot) 

package  body  Lateral_Directional_Autopilot  is 
—  — Initial  values  for  Aileron  Control  Loop 


Aileron_Cmd_Roll_Rate_Gain  :  Feedback_Rate  Gains 

Initial_RoIl_Rate_Gain_For_Aileron; 
Aileron_Cmd_Yaw_Rate_Gain  :  Feed back_Rate_Ga ins  :« 

Initial_Yaw_Rate_Gain_For_Aileron; 

—  — Initial  values  for  rudder  control  loop 


Rudder_Cmd_Roll_Rate_Gain  :  Rudder_Cmd_Roll_Rate_Gains  :- 

Initial_Roll_Rate~Gain_For_Rudder; 
Rudder_Cmd_Feedback_Rate_Gain  :  Feedback_Rate_Gains  7- 

Initial  Yaw  Rate  Gain  For  Rudder; 


—  Packages  for  Aeliron  control  loop 

package  Aileron_Cmd_Tustin_Integrator  is  new 

Signal_Processing.Tustin_Integrator_Vith  Limit 
(Signals  ->  Roll_CommanJs, 
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States 

Gained_Signals 

Gains 

Ini tial_Tustin_Gain 
Initial_Signal_Level 
Ini tial_Signal_Limi t 


=>  Fin_Deflections, 

»>  Fin-Deflections, 

=>  Roll  Command_Gains, 

=>  InitIal_Aileron  Integrator_Gain, 

->  0.0, 

»>  Initial_Aileron_Integrator_Limit) ; 


package  Aileron_Cmd_Integral  Plus_Proportional_Gain  is  new 
Integral_Plus_ProportionaI_Gain 

(Input_Signals  ■>  Roll_Commands, 

Gains  ■>  Roll_Command_Gains, 

Integrated_Sigr als  ■>  Fin_Def lections, 

Initial_Proportional_Gain  ->  Initial_Roll_Command_Proportional_Gain, 

Tustin_Integrate  ■>  Aileron~Cmd_Tustin_Integrator. Integrate) ; 

package  AileronJLoop  renames  Aileron_Cmd_Integral_Plus_Proportional_Gain; 


—  Packages  for  rudder  control  loop 


package  Rudder_Cmd  Tustin  Integrator  is  new 

Signal_FrocessTng .  Tus  t  in_In  t  egra  t  or_Wi  th_Limi  t 


(Signals  -> 
States  -> 
Gained_Signals  -> 
Gains  ■> 
Initial_Tustin_Gain  ■> 
Initial_Signal_Level  -> 
Ini tial_Signal_Limit  ■> 


Missile  Accelerations, 

Fi n_De f Tec t i ons , 

Fin~Def lections, 
Acceleration_Gains , 

Initial  Rudder  Integrator  Gain, 
0.0,  ~  “ 
Initial  Rudder  Integrator  Limit); 


package  Rudder_Cmd_Integral_Plus  Proportional_Gain  is  new 
Integral_Plus_Proportional_GaTn 

(Input_Signals  »>  Missile_Accelerations, 

Gains  »>  Acceleration_Gains, 

Integrated_Signals  ->  Fin_Def lections, 

Initial_Proportional_Gain  ->  Initial_Acceleration_Proportional_Gain, 

Tustin_Integrate  ->  Rudder_Crad_Tustin_Integrator. Integrate) ; 


package  Rudder_Loop  renames  Rudder_Cmd_Integral_Plus_Proportional_Gain; 


end  Lateral  Directional  Autopilot ; 


3. 3. 4. 2. 9. 2. 7  UTILIZATION  OF  OTHER  ELEMENTS 

The  following  library  units  are  with'd  by  this  part: 

1.  Signal_Processing 

UTILIZATION  OF  EXTERNAL  ELEMENTS: 

Packages : 

The  following  table  summarizes  the  external  packages  required  by  this  part: 
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Name 


|  Type  | Source |  Description 


Tustin_Integrator 
With  Limit 


Generic 

Package 


This  package  is  required  for 
the  integration  function  in 
the  integral  plus  proportional 
packages.  It  is  instantiated 
for  the  roll  command  control 
loop  and  for  the  acceleration 
feedback  control  loop. 


UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Packages : 

The  following  table  summarizes  the  packages  i  squired  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 


Type  |  Source  |  Description 


In  tegral_Plus_Propor  t ional 
Gain 


Generic |  Package 
Package!  Spec. 


Performs  integrator 
function  on  roll 
command  error  and 
lateral  accelera¬ 
tion  feedback 


Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
ancestral  units: 


|  Name 

1  Type  | 

|  Source  | 

|  Description  | 

|  Aileron  Rudder  Commands 

|  Record 

|  Package  Spec. | 

Defines  record  with 

1  1 

components  for  rud- 

1  1 

1  1 

and  aileron  commands 

3. 3. 4. 2. 9. 2. 8  LIMITATIONS 


None. 


3. 3. 4. 2. 9. 2. 9  LLCSC  DESIGN 


None. 
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3.3.4.2.9.2.10  UNIT  DESIGN 

3.3.4.2.9.2.10.1  INITIALIZE_LATERAL_DIRECTIONAL_AUTOPILOT  UNIT  DESIGN 
Initializes  state  of  integrator  in  lateral  directional  autopilot. 


3.3.4.2.9.2.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064  (2). 


3.3.4.2.9.2.10.1.2  LOCAL  ENTITIES  DESIGN 
None. 


3.3.4.2.9.2.10.1.3  INPUT/OUTPUT 


GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

Type 

Description  | 

|  FinDeflections 

Generic  Float 

Type  for  rudder  and 
aileron  commands 

j  Missile_Accelerations 

Generic  Float 

Type  for  measured 
lateral  acceleration 

j  Roll_Coramands 

Generic  Float 

Type  for  input  commands 
from  user  program 

j  Feedback_Rates 

Generic  Float 

Type  for  measured  roll 
and  yaw  rates 

|  Velocities 

1 

Generic  Float 

Type  for  measured 
missile  velocity 

|  Roll_Attitudes 

Generic  Float 

Type  for  measure  missile 
roll  attitude 

Subprograms: 

The  following  table  summarizes  the  generic  formal  subroutines  required  by  this 
part: 


CAMP  Software  Detailed  Design  Document 


Page  520 


Name 


|  Type  |  Description 


For  Aileron  State  Initialization 


»»*» 


|  function 

I 


function 


I 

|  function 

I 


Subtracts  Roll_Attitudes  from 
Roll_Coramands  returning  Roll_ 
Error 

Multiplies  Roll_Commands  by 
Roll  Command_Gains  for  input 
to  Aileron  integrator 
Multiplies  Feedback_Rates  for 
measured  roll  and  yaw  rates 
by  Feedback  Rate_Gains 
for  Fin  Deflections 


For  Aileron  State  Initialization 


I 


1 

1 

1 

function 

Multiplies  Gravitational 
Accelerations  by  Trig  Value 
returns  Gravitational_ 
Accelerations 

1  "/" 

1 

1 

function 

Divides  Gravitational_Acceler- 
ations  by  Velocities  returns 
Feedback  Rates 

1  «*» 

1 

function 

Multiplies  Feedback_Rates  by 
Rudder_Cmd_Roll  Rate_Gains 
returns  Feedback  Rates 

1  "*" 

1 

1 

1 

1 

function 

Multiplies  Missile_Accelera- 
tions  by  Acceleration_Gains 
returns  Fin  Deflections  for 
proportional  loop  of 
integral  plus  proportional 
gain 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 
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|  Name  | 

Type 

1 

Description  | 

Initial  Aileron  | 

Fin  Deflections 

1 

Initial  state  for 

Command  | 

aileron  deflection 

Initial  Rudder  Command j 

Fin  Deflections 

1 

Initial  state  for  rudder 

1 

deflection 

Gravitational 

Gravitational 

1 

Measured  gravitational 

Acceleration 

Accelerations 

acceleration  from  NAV 

Roll  Command  i 

Roll  Commands 

1 

Initial  roll  command 

Roll  Attitude  j 

Roll  Attitudes 

1 

Measured  roll  attitude 

Roll  Rate  j 

Feedback  Rates 

1 

Measured  roll  rate  feed- 

1 

back 

Yaw  Rate 

Feedback  Rates 

1 

Measured  yaw  rate  feed- 

1 

back 

Missile  Velocity 

Velocities 

Measured  velocity  from 

Lateral  Acceleration  j 

Missile  Accel- 

1 

1 

NAV 

Measured  lateral  accel- 

erations 

1 

from  NAV 

3.3.4.2.9.2.10.1.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 


Type  |  Description 


GainedRoll 
Command  Signal 
Initial_Alleron_ 
State 

Initial_Rudder_ 

State 


Pin  Deflections 


Input  to  integrator 


Fin_Delfections I  Initial  state  of  integrator 

for  aileron 

Fin_Deflections j  Initial  state  of  integrator 

for  rudder 


3.3.4.2.9.2.10.1.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.2.9.2.10.1.6  PROCESSING 


The  following  describes  the  processing  performed  by  this  part: 


procedure  Initialize  Lateral_Directional_Autopilot 

(InitiaI_Aileron_Command  T  in  Fin_Deflections; 

Initial_Rudder_Command  :  in  Fin_Def lections; 

Gravitational_Acceleration  :  in  Gravi tat ional_Accelerat ions 

RollCommand  :  in  Roll_CommandsJ 

Roll”Attitude  :  in  Roll~Attitudes; 

Roll_Rate  :  in  FeedEack_Rates; 

Yaw  Rate  :  in  Feedback~Rates ; 


9 
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( 

Missile_Velocity  :  in  Velocities; 

Lateral  Acceleration  :  in  Missile_Accelerations)  is 

Gained_Roll_Command_Signal  :  Fin_Def lections; 

Initial_Aileron_State  :  Fin_Deflections; 

Initial_Rudder_State  :  Fin_Def lections; 

begin 

Gained_Roll_Command_Signal  : - 

(Roll_Comraand  -  Roll_Attitude)  * 

Initial_Roll_Command_Proportional_Gain; 

Initial_Aileron  State  :- 

InitIal_Aileron_Command  - 
Gained_Roll_Command_Signal  + 

Yaw  Rate  *  Aileron_Cmd  Yaw_Rate_Gain  + 

Roll  Rate  *  Ai  leron_Cm3_Yaw_Ra t e_Gain ; 

Initial_Rudder_State  :- 

Initial_Rudder_Command  - 
(Yaw  Rate  - 

(Gravi tational_Acceleration  *  Sin  (Roll_Attitude) 

/  Misiile_Velocity)  - 
(Roll  Rate  *  Rudder_Cmd  Roll  Rate_Gain) 

)  *  RuJder_Cmd_Feedback  Kate_Sain  - 

Lateral_Acceleration  *  Tni  tial_Acceleration_Proportional_Gain; 

Aileron_Cmd_Tustin_Integrator.  Reset 

(IntegratorState  ->  Initial_Aileron_State, 

Signal  ->  0.0); 

Rudder_Cmd_Tustin_Integrator .Reset 

(Integrator_State  ->  Initial_Rudder_State, 

Signal  ->  0.0); 

end  Initialize_Lateral_Directional_Autopilot; 


3.3.4.2.9.2.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 
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1 

Name 

|  Type  j 

Source  | 

Description 

1 

1 

Aileron  Cmd  Tustin 

|  Package | 

Package  | 

Implements  integrator 

1 

1 

Integrator 

1  1 

Body 

for  roll  command 

1 

1  1 

loop 

Rudder  Cmd  Tustin 

|  Package | 

Package  j 

Implements  integrator 

1 

Integrator 

!  1 

Body  ! 

for  acceleration 

1 

I 

1  1 

feedback  loop 

1 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type 

|  Source  | 

Description  | 

Reset 

|  Function 

1  Aileron  Cmd  Tustin  1 

Reinitializes  state  | 

Integrator  (Pack.)j 

of  integrator  ( 

Reset 

|  Function 

|  Rudder  Cmd  Tustin  1 

Reinitializes  state 

1 

j  Integrator  (Pack.)j 

of  integrator  1 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

Type 

Source 

Description  | 

Aileron_ 

Integrator  Gain 

Roll_Command_Gains 

Body 

Gain  on  input  to  aileron 
command  loop  integrator 

Ai leron_Cmd_Roll_ 
Rate  Gain 

Feedback_Rate_Gains 

Body 

Gain  on  roll  rate  feedback 
in  aileron  command  loop 

Ai leron_Cmd_Yaw_ 

Rate  Gain 

Feedback_Ra  t  e_Ga i ns 

Body 

Gain  on  yaw  rate  feedback 
in  aileron  command  loop 

Rudder_Cmd_Roll_ 

Rate  Gain 

Rudder_Cmd_Ro 1 1_ 
Rate  Gains 

Body 

Gain  to  roll  rate  feedback 
in  rudder  command  loop 

Rudder_Cmd_Feedback_ 
Rate  Gain 

Feed  back_Ra t e_Ga ins 

Body 

Gain  to  yaw  rate  feedback 
in  rudder  command  loop 

Acceleration_Propor- 
tional  Gain 

Acceleration_Gains 

Body 

Proportional  gain  to 
acceleration  feedback  in 

Rudder_Integrator_ 

Gain 

Acceleration_Gains 

Body 

Gain  on  acceleration  input 
to  rudder  command  loop 
integrator 

3.3.4.2.9.2.10.1.8  LIMITATIONS 


None. 
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3.3.4.2.9.2.10.2  C0MPUTE_AI LER0N_RUDDER_C0MMANDS ( FUNCTION  BODY)  UNIT  DESIGN 

Computes  Aileron  and  Rudder  commands  based  on  roll  command  input  and  current 
missile  state. 


3.3.4.2.9.2.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064  (3). 


3.3.4.2.9.2.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.2.10.2.3  INPUT/OUTPUT 


GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  external  types  required  by  this  part: 


|  Name 

Type 

Description  | 

RollCommands 

Generic  Float 

Type  for  input  commands 
from  user  program 

RollAttitudes 

Generic  Float 

Type  for  measure  missile 
roll  attitude 

Feedback_Rates 

Generic  Float 

Type  for  measured  roll 
and  yav  rates 

Missile_Acclerations 

Generic  Float 

Type  for  measured 
lateral  acceleration 

FinDeflections 

Generic  Float 

Type  for  rudder  and 
aileron  commands 

Velocities 

Generic  Float 

Type  for  measured 
missile  velocity 

Gravitational_ 

Accelerations 

Generic  Float 

Type  for  measured  gravi- 
tationll  acceleration 

Subprograms : 

The  following  table  summarizes  the  generic  formal  subroutines  required  by  this 
part: 
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|  Name 

1  Type 

|  Description 

1 

|  Aileron  control 

loop  limiters  and 

filters 

1 

Roll_Error_Limi t 
Aileron  Command  Limit 


|  function 
j  function 


Limiter  for  roll  error 
Limit  on  command  signal  to 
aileron 

Filter  applied  to  input  roll 
command 


Roll  Command  Filter  |  function 

I 

Rudder  control  loop  limiters,  filters,  and  operations 


Rudder  Command  Limit 

|  function 

Sin 

|  function 

Yaw  Rate  Filter 

1 

|  function 
| 

Acceleration  Filter 

1 

|  function 

I 


Limit  on  command  signal  to 
rudder 

Sin  function  applied  to 
measured  roll  attitude 

Filter  applied  to  measured 
yaw  rate 

Filter  applied  to  measured 
acceleration  feedback 


Aileron  control  loop  gain  and  updater  functions 

I  function 


function 


Subtracts  Roll_Attitudes  from 
Roll_Commands  returning  Roll_ 
Error 

Multiplies  FeedbackRates  for 
measured  roll  and  yav  rate 
by  Feedback  Rate_Gains 
for  Fin  Deflections 


Rudder  control  loop  gain  and  updater  functions 


|  function 

n /n 

1 

|  function 
1 

"*» 

1 

1  function 

Multiplies  Gravitational 
Accelerations  by  Trig_Value 
returns  Gravitational_ 
Accelerations 

Divides  Gravitational_Acceler- 
ations  by  Velocities  returns 
Feedback_Rates 

Multiplies~Feedback_Rates  by 
Rudder_Cmd_Roll  Rate_Gains 
returns  Feedback  Rates 


FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 
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i 


|  Name 


Type 


|  Description 


RollCommand 

Roll_Attitude 

Roll~Rate 

Yav_Rate 

Lateral_Acceleration 

Missile_Veloci ty 

Gravitational_ 

Acceleration 


Roll_Commands 
Roll  Attitudes 
FeedSack_Rates 

Feedback_Rates 

Missile_Accel- 

erations 

Velocities 

Gravitational_ 

Accelerations 


Input  roll  command 

Measured  roll  attitude 

Measured  roll  rate  feed¬ 
back 

Measured  yaw  rate  feed¬ 
back 

Measured  ral  accel- 
from  N* 

Measured  vexocity  from 
NAV 

Measured  gravitational 
acceleration  from  NAV 


3.3.4.2.9.2.10.2.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

Type 

Description  | 

I  Filtered  Roll 

Roll  Commands 

Input  roll  command  after 

|  Command 

filtering 

j  Roll  Error 

Roll  Commands 

-Piltered  Roll  Command  - 

Roll  Attitude  (Limited) 

j  Aileron_Integral_ 
j  Output 

Fln_Deflections 

Output  from  aileron  loop  inte¬ 
gral  plus  prop,  gain 

j  Filtered  Yaw  Rate 

Feedback  Rates 

Yaw  rate  feedback  after 

filtering 

I  Filtered  Lateral 

Missile  Accel- 

Acceleration  feedback  after 

j  Acceleration 

erations 

filtering 

j  Rudder  Integral 

Fin  Deflections 

Output  from  rudder  loop  inte- 

|  Output 

gral  plus  prop,  gain 

j  Fin  Command 

Aileron  Rudder 

Contains  aileron  and  rudder 

Commands 

command  components 

3.3.4.2.9.2.10.2.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.2.9.2.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  Compute  Aileron  Rudder_Commands 

(RolI_Comman3  ”  :  in  Roll_Commands; 

Roll_Attitude  :  in  Roll  Attitudes; 

Roll  Rate  :  in  FeedEack Rates; 
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Yav_Rate 

Lateral_Acceleration 
Missile_Veloci ty 
Gravi tational_Acceleration 
return  Aileron  Rudder  Commands  is 


:  in  Feedback_Rates; 

:  in  Missile  Accelerations; 

:  in  Velocities; 

:  in  Gravitational  Accelerations) 


Filtered_Roll_Command 

Roll_Error 

Aileron  Integral_Output 
Fi 1 tere3_Yav_Ra  t e 
Filtered_Lateral_Acceleration 
Rudder_Integral_Output 
Fin  Command 


Roll_Commands; 

Roll_Commands; 

Fin  Deflections; 
Fee3back_Rates; 

Missile  Accelerations; 
Fin_DefTections; 

Aileron  Rudder  Commands; 


begin 

— Aileron  command  computations 


Filtered_Roll_Command  :»  Roll_Command_Filter  (RollCommand) ; 

Roll_Error  Filtered_Roll_Command  -  Roll_Attitude; 

Roll_Error  :»  Roll_Error_Limit  (Roll_Error) ; 

Aileron_Integral_Output  Aileron_Loop. Integrate  (Roll  Error) ; 

Filtered  Yaw  Rate  YavRateFilter  (YavRate); 

FinCommand. Aileron  Command 

Aileron_Command_Iimit  (Aileron  Integral_Output  - 

Filtere3_Yaw  Rate  *  Aileron  Cmd_Yav_Rate_Gain  - 
Roll_Rate  *  Xileron_Cmd_RolI_Rate_Gain) ; 

— Rudder  command  computations 


Filtered_Lateral_Acceleration  :■ 

Acceleration_Filter  (Lateral_Acceleration) ; 

Rudder_Integral_Output  s»  Rudder  Loop. Integrate 

(FiItered_Lateral_Acceleration); 


Fin_Command.Rudder_Command  :■ 

Rudder_Command_Limi  t 

(Rudder_Integral_Output  + 

(Filtered_Yav_Rate  - 

(Gravi taIional_Acceleration  *  sin  (Roll_Attitude)  / 
Missile_Velocity)  - 

Roll_Rate  *  Rudder  Cmd_Roll  Rate_Gain)  * 

Rudder  Cmd  Feedback  Rate  Gain 
)  5 


return  (Fin_Command); 


end  Compute  Aileron  Rudder  Commands ; 
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3.3.4.2.9.2.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 


Type  |  Source  |  Description 


Aileron_Cmd_Integral 
Plus_Proportional_ 
Gain~( renamed: 
Aileron  Loop) 
Rudder_Cm3_Integral 
Plus_Proportional_ 
Gain  (renamed: 
Rudder  Loop) 


Package | 

Package 

1 

1 

Body 

1 

Package | 

Package 

1 

1 

1 

Body 

Implements  integral 
plus  proportional 
gain  for  roll  command 

Implements  integral 
plus  proportional 
gain  for  acceleration 
feedback 


Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsevhere  in  the  parent  top  level  component: 


|  Name  |  Type  |  Source 


Description 


Integrate  |  Function  |  Aileron  Loop 

I  I 

I  I 

Integrate  |  Function  |  Rudder  Loop 


Performs  integral 
plus  proportional 
gain  on  roll  error 
Performs  integral 
plus  proportional 
gain  on  accelera¬ 
tion  feedback 


Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
ancestral  units: 


|  Name 

Type 

Source  | 

Description  | 

|  Aileron 

1 

_Rudder_Commands 

Record 

Package  Spec. | 

1 

1 

Defines  record  with  | 
components  for  rud-  j 
and  aileron  commands! 
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Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 


Type 


Sourcej  Description  | 


Aileron  Cmd_Yaw_ 
Rate_Gain 
Aileroii_Cmd_Roll_ 
Rate_Gain 
Rudder_Cmd_Roll_ 
Rate_Gain 

Rudde  r_Cmd_Feed  back 
Rate  Gain 


Feedback_Rate_Gains | 

Body 

Feedback  Rate  Gains j 
~  | 

Body 

1 

Rudder  Cmd  Roll 

Body 

Rate  Gains  j 

Feedback_Rate_Gains  j 

Body 

[Gain  on  yaw  rate  feedback 
jin  aileron  command  loop 
jGain  on  roll  rate  feedback 
j in  aileron  command  loop 
jGain  to  roll  rate  feedback 
j in  rudder  command  loop 
jGain  to  yaw  rate  feedback 
j  in  rudder  command  loop 


3.3.4.2.9.2.10.2.8  LIMITATIONS 


None. 


3.3.4.2.9.2.10.3  UPDATE_AILERON_INTEGRATOR_GAIN  UNIT  DESIGN 

Updates  the  current  value  of  the  Aileron  Integrator  Gain  as  controlled  by  the 
Ai  le  r onCmdTus  t  i  n_In  t  egr  a  t  o  r . 


3.3.4.2.9.2.10.3.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 


3.3.4.2.9.2.10.3.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.2.10.3.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

Description  | 

|  Aileron  Integrator 

|  Generic  Float 

Gains  applied  to 

j  Gains 

1 

roll  commands 
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FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  New  Gain 

1 

|  Aileron_Integra- 
I  tor_Gains 

|  New  value  for  Gain  applied  | 

!  to  roll  commands  j 

3.3.4.2.9.2.10.3.4  LOCAL  DATA 


None. 


3.3.4.2.9.2.10.3.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.2.9.2.10.3.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  UpdateAileron  IntegratorGain 

(New_Gain:  Tn  Roll  Command_Gains)  is 

begin 

Aileron_Cmd_Tustin_Integrator.Update_Gain  (Nev_Gain  ■>  New_Gain); 
end  Update_Aileron_Integrator_Gainj 


3.3.4.2.9.2.10.3.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type  | 

Source 

|  Description  j 

1  Aileron  Cmd  Tustin 

|  Package | 

Package 

|  Implements  integrator  | 

j  Integrator 

1  1 

Body 

for  roll  command 

1 

1  1 

1  loop  j 

< 


Subprograms  and  task  entries: 
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The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type  | 

Source  | 

Description  | 

|  Update 

|  Procedure) 

Aileron  Cmd  Tustin  1 

Updates  value  of  gain| 

i  Gain 

1  1 

Integrator  (Pack.)j 

in  integrator  j 

3.3.4.2.9.2.10.3.8  LIMITATIONS 


None. 


3.3.4.2.9.2.10.4  UPDATEAILERONINTEGRATORLIMIT  UNIT  DESIGN 

Updates  the  current  value  of  the  limit  on  output  from  the  aileron  control  loop 
integrator. 


3.3.4.2.9.2.10.4.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 


-'MM  * 

(•  3.3.4.2.9.2.10.4.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.2.10.4.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Fin  Deflections 

|  Generic  Float 

|  Output  from  aileron  | 

" 

1 

|  control  loop  j 

1 

1 

j  integrator  j 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 
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|  Name 

I  Type 

|  Description  | 

|  New  Limit 

1  “ 

|  Fin  Deflections 

1 

|  New  value  for  limit  on  I 

|  integrator  output  j 

3.3.4.2.9.2.10.4.4  LOCAL  DATA 


None. 


3.3.4.2.9.2.10.4.5  PROCESS  CONTROL 


Not  applicable. 


3.3.4.2.9.2.10.4.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Aileron_Integrator  Limit 

(New_Limit  :  in  Fin_DeIlections)  is 


begin 

AileronCmd  Tustin_Integrator.Update_Limit  I 

(fiew_Absolute_Limit  »>  Nev_Limit); 

end  Upda  t e_Ai  leron_In  t  egra  t  or_Li  nit; 


3.3.4.2.9.2.10.4.7  UTILIZATION  OP  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsevhere  in  the  parent  top  level  component: 


|  Name 

1  Type  | 

Source 

|  Description  | 

1  Aileron  Cmd  Tustin 

Package | 

Package 

|  Implements  integrator 

1  Integrator 

1 

Body 

!  for  roll  command 

1  1 

1 

|  loop 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsevhere  in  the  parent  top  level  component: 
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|  Name 

1  Type  | 

Source 

Description  | 

I  Update 

|  Procedure | 

Aileron  Cmd  Tustin  ! 

Updates  value  of  { 

j  Limit 

1  1 

Integrator  (Pack.)| 

limit  in  integrator! 

3.3.4.2.9.2.10.4.8  LIMITATIONS 
None. 

3.3.4.2.9.2.10.5  UPDATE JtOLL_COMMAND_PROPORTIONAL_GAIN  UNIT  DESIGN 

Updates  the  current  value  of  the  Roll_Command_Proportional_Gain  of  of  the 
aileron  control  loop 


3.3.4.2.9.2.10.5.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 

3.3.4.2.9.2.10.5.2  LOCAL  ENTITIES  DESIGN  . 

None. 

3.3.4.2.9.2.10.5.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

!  Type 

|  Description  | 

|  Roll  Gains 

1 

|  Generic 

1 

Float  |  Proportional  gains  | 

to  roll  commands  j 

FORMAL  PARAMETERS: 

The  following  table 

summarizes  the 

formal  parameters  required  by  this 

|  Name  | 

Type 

|  Description  | 

|  New  Gain  | 

1  "  1 

Roll_Gains 

|  New  value  for  proportional  | 
j:  gain  to  roll  commands  | 
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3.3.4.2.9.2.10.5.4 


* 


LOCAL  DATA 


None. 


3.3.4.2.9.2.10.5.5  PROCESS  CONTROL 


Not  applicable. 


3.3.4.2.9.2.10.5.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Roll_Command  Proportional  Gain 
(Nev_Gain:  in  RoIl_Command_GaTns)  is 


begin 

Aileron_Loop.Update_Proportional_Gain  (New_Proportional_Gain  ->  New_Gain); 
end  Update_Roll_Command_Proportional_Gain; 


3.3.4.2.9.2.10.5.7  UTILIZATION  OP  OTHER  ELEMENTS 
UTILIZATION  OP  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 


elsewhere  in  the  parent 

top  level 

component: 

|  Name 

1  Type  | 

Source  | 

Description  | 

|  Aileron_Cmd_Integral_ 

!  Plus_Proportional_ 
j  Gain  -  Aileron_Loop 

Package | 

1 

1 

Package  j 
Body  i 

1 

Implements  integral  | 

plus  proportional 
gain  for  aileron  loopj 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name  |  Type  | 

Source 

|  Description  | 

|  Update  Pro- | Procedure! 
j  tional_  i  j 
j  Gain  j  j 

Aileron_Loop 

|  Updates  value  of  | 

l  proportional  gain  j 

1  1 

« 
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3.3.4.2.9.2.10.5.8  LIMITATIONS 


None. 


3.3.4.2.9.2.10.6  UPDATE_ROLL_RATE_GAIN_FOR_AILERON  UNIT  DESIGN 

Updates  the  current  value  of  the  Aileron_Cmd_Roll_Rate_Gain  of  of  the  aileron 
control  loop 


3.3.4.2.9.2.10.6.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 


3.3.4.2.9.2.10.6.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.2.10.6.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

Description  | 

|  Feedback  Rate  Gains 

|  Generic  Float 

Gains  to  roll  rate 

1 

feedback  for  aileron  I 

1 

1 

commands  i 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  New  Gain 

|  Feedback  Rate 

Nev  value  for  gain  to  roll  | 

1 

|  Gains 

rate  feedback  j 

3.3.4.2.9.2.10.6.4  LOCAL  DATA 


None. 
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3.3.4.2.9.2.10.6.5  PROCESS  CONTROL 
Not  applicable. 

3.3.4.2.9.2.10.6.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Roll_Rate_Gain  For  Aileron 

(New_Gain  :  in  Fee<IbacIc_Rate_Gains)  is 

begin 

Aileron_Cmd_Roll_Rate_Gain  :■  New_Gain; 
end  Update_Roll_Rate_Gain_For_Aileron; 

3.3.4.2.9.2.10.6.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3.3.4.2.9.2.10.6.8  LIMITATIONS 
None. 

3.3.4.2.9.2.10.7  UPDATE_YAV_RATE_GAIN_FOR_AI LERON  UNIT  DESIGN 

Updates  the  current  value  of  the  Aileron_Cnd_Yav_Rate_Gain  of  of  the  aileron 
control  loop 


3.3.4.2.9.2.10.7.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 

3.3.4.2.9.2.10.7.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.4.2.9.2.10.7.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 
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|  Name 

1  Type 

Description  | 

|  Feedback.  Rate  Gains 

j  Generic  Float 

Gains  to  yaw  rate  i 

i 

1 

feedback  for  aileron  j 

1 

1 

commands 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  New  Gain 

1 

|  Feedback_Rate 
j  Gains 

|  New  value  for  gain  to  yaw 
j  rate  feedback 

3.3.4.2.9.2.10.7.4  LOCAL  DATA 
None. 

3.3.4.2.9.2.10.7.5  PROCESS  CONTROL 
Not  applicable. 

3.3.4.2.9.2.10.7.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update  Yaw_Rate_Gain_For_Aileron 

(New_GaIn  :~in  Feed back_Rate_Ga ins)  is 

begin 

Aileron_Cmd_Yav_Rate_Gain  :■  New_Gain; 
end  Update_Yav_Rate_Gain_For_Aileron ; 

3.3.4.2.9.2.10.7.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3.3.4.2.9.2.10.7.8  LIMITATIONS 


None. 
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3.3.4.2.9.2.10.8  UPDATE_RUDDER_INTEGRATOR_GAIN  UNIT  DESIGN 

Updates  the  current  value  of  the  Rudder_Integrator_Gain  for  the  integrator  part 
of  the  rudder  control  loop  integral  plus  propotional  gain. 


3.3.4.2.9.2.10.8.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 


3.3.4.2.9.2.10.8.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.2.10.8.3  INPUT/OUTPUT 


GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Rudder  Integrator 

|  Generic  Float 

|  Gains  applied  to  accel- 

j  Gains 

1 

ation  feedback 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  New  Gain 

1 

|  Rudder_integra- 
1  tor_Gains 

|  Nev  value  for  Gain  applied  | 

•  to  acceleration  j 

3.3.4.2.9.2.10.8.4  LOCAL  DATA 
None. 


3.3.4.2.9.2.10.8.5  PROCESS  CONTROL 
Not  applicable. 
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3.3.4.2.9.2.10.8.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update  Rudder_Integrator_Gain 

(New_GaIn  :  in~Acceleration_Gains)  is 

begin 

Rudder_Cmd_Tustin_Integrator.Update_Gain  (New_Gain  ->  New_Gain); 
end  Update_Rudder_Integrator_Gain; 


3.3.4.2.9.2.10.8.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type  | 

Source  | 

|  Description  | 

Rudder  Cmd  Tustin 

|  Package | 

Package 

Implements  tustin  int-  | 

Integrator  I 

1  1 

Body 

egrator  for  rudder  j 

1  1 

loop  | 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name 

Type  | 

Source 

|  Description  | 

I  Update  Gain 

Procedure | 

Rudder  Cmd  Tustin 

|  Updates  value  of  I 

1 

1 

1 

1 

Integrator 

integral  gain  ) 

I  1 

3.3.4.2.9.2.10.8.8  LIMITATIONS 


None. 


3.3.4.2.9.2.10.9  UPDATE_RUDDER_INTEGRATOR_LIMIT  UNIT  DESIGN 

Updates  the  current  value  of  the  limit  on  output  from  the  rudder  control  loop 
integrator. 
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3.3.4.2.9.2.10.9.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 

3.3.4.2.9.2.10.9.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.4.2.9.2.10.9.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

Description  | 

|  Fin  Deflections 

|  Generic  Float 

Output  from  rudder  | 

1 

1 

control  loop 

I 

1 

integrator  j 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 

|  Name  |  Type  |  Description  | 

|  New_Limit  |  Fin_Def lections  New  value  for  limit  on 

j  j  integrator  output 


3.3.4.2.9.2.10.9.4  LOCAL  DATA 
None. 

3.3.4.2.9.2.10.9.5  PROCESS  CONTROL 
Not  applicable. 

3.3.4.2.9.2.10.9.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Rudder_Integrator_Limi t 

(Nev_Limit  :  in  Fin_Deflections)  is 


begin 
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Rudder_Cmd_Tustin_Integrator .Update_Limi t 

<New_Absolute_Limit  =*>  Nev_Limit); 

end  Update_Rudder_Integrator_Limi t ; 


3.3.4.2.9.2.10.9.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type  | 

Source 

|  Description  | 

1  Rudder  Cmd  Tustin 

|  Package | 

Package 

|  Implements  tustin  int-  | 

I  Integrator 

1  1 

Body 

j  egrator  for  rudder 

1 

1  1 

1  loop  | 

Subprograms  and  task  entries: 

The  folloving  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsevhere  in  the  parent  top  level  component: 


|  Name 

1  Type  | 

Source 

Description  | 

Update_ 

Limit 

| Procedure | 

1  1 

1  1 

Rudder_Cmd_Tus  t in_ 
Integrator 

Updates  value  of  j 

limit  on  integrator! 
output  j 

3.3.4.2.9.2.10.9.8  LIMITATIONS 


None. 


3.3.4.2.9.2.10.10  UPDATE_FEEDBACK_RATE_GAIN_FOR_RUDDER  UNIT  DESIGN 

Updates  the  current  value  of  the  Rudder_Cmd_Feedback_Rate_Gain  of  the  yaw  rate 
for  the  rudder  control  loop 


3.3.4.2.9.2.10.10.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 
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3.3.4.2.9.2.10.10.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.2.10.10.3  INPUT/OUTPUT 


GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

I  Type  | 

|  Description  | 

|  Feedback  Rate  Gains 

|  Generic  Float  | 

|  Gains  to  yaw  rate 

1  "  " 

1 

feedback  for  rudder 

1 

1  1 

commands 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name  | 

Type 

|  Description  | 

|  New  Gain  | 

Feedback  Rate 

|  New  value  for  gain  to  yaw  | 

1  “  1 

Gains 

rate  feedback  j 

3.3.4.2.9.2.10.10.4 

LOCAL  DATA 

None. 

3.3.4.2.9.2.10.10.5 

PROCESS  CONTROL 

Not  applicable. 

3.3.4.2.9.2.10.10.6 

PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Feedback  Rate_Gain  For_Rudder 

(New_Gain  :  In  Feedbaclc_Rate_Gains)  is 

begin 

Rudder_Cmd_Feedback_Rate_Gain  :■  New_Gain; 
end  Update_Feedback_Rate_Gain_For_Rudder ; 
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3.3.4.2.9.2.10.10.7  UTILIZATION  OF  OTHER  ELEMENTS 


None. 


3.3.4.2.9.2.10.10.8  LIMITATIONS 
None. 


3.3.4.2.9.2.10.11  UPDATE_ROLL_RATE_GAIN_FOR_RUDDER  UNIT  DESIGN 

Updates  the  current  value  of  the  Rudder_Cmd_Roll_Rate_Gain  for  the  rudder 
control  loop 


3.3.4.2.9.2.10.11.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 


3.3.4.2.9.2.10.11.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.2.10.11.3  INPUT/OUTPUT 


GENERIC  PARAMETERSi 
Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

1  Rudder  Cmd  Roll  Rate 

|  Generic  Float  | 

|  Gains  to  roll  rate 

|  Gains 

1 

feedback  for  rudder 

1 

1  1 

commands 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  New  Gain 

1  Feedback  Rate 

|  New  value  for  gain  to  roll  | 

1 

i  Gains 

,  rate  feedback  | 
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3.3.4.2.9.2.10.11.4  LOCAL  DATA 
None. 

3.3.4.2.9.2.10.11.5  PROCESS  CONTROL 
Not  applicable. 

3.3.4.2.9.2.10.11.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Roll_Rate_Gain  For_Rudder 

(New  Gain  :  in  Rud3er_Cmd_Roll_Rate_Gains)  is 

begin 

Rudder_Cmd_Roll_Rate_Gain  New_Gain; 
end  Update_Roll_Rate_Gain_For_Rudder; 

3.3.4.2.9.2.10.11.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3.3.4.2.9.2.10.11.8  LIMITATIONS 
None. 

3.3.4.2.9.2.10.12  UPDATE_ACCELERATION_PROPORTIONAL_GAIN  UNIT  DESIGN 

Updates  the  current  value  of  the  Acceleration_Proportional_Gain  of  of  the 
rudder  control  loop 

3.3.4.2.9.2.10.12.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R064. 

3.3.4.2.9.2.10.12.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.4.2.9.2.10.12.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 
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Data  types: 


CAMP  Software  Detailed  Design  Document 


Page  545 


The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

I  Type 

Description  | 

|  Acceleration  Gains 

|  Generic  Float 

Proportional  gains  | 

1 

! 

to  acceleration  j 

1 

1 

feedback 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  New  Gain 

|  Roll  Gains 

|  Nev  value  for  proportional 

! 

1 

i  gain  to  acceleration 

3.3.4.2.9.2.10.12.4  LOCAL  DATA 


None. 


3.3.4.2.9.2.10.12.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.2.9.2.10.12.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Acceleration_Proportional_Gain 

(Nev_Gain  s  in  Acceleration_Gains)  is 


begin 

Rudder_Loop.Update_Proportional_Gain  (Nev_Proportional_Gain  *>  Nev_Gain); 
end  Update_Acceleration_Proportional_Gain; 


3.3.4.2.9.2.10.12.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsevhere  in  the  parent  top  level  component: 
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|  Name 

1  Type  | 

Source 

|  Description  | 

|  Rudder  Cmd  Integral_  1 
j  Plus  Proportional_  ! 
1  Gain  =  Rudder  Loop  | 

Package | 

1  f 

1 

Package 

Body 

|  Implements  integral 

1  plus  proportional 

!  gain  for  rudder  loop  | 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name  |  Type  | 

Source  | 

|  Description  | 

|  Update  Pro- | Procedure | 
j  tional_  j 

j  Gain  j  j 

Rudder_Loop 

Updates  value  of 

1  proportional  gain 

3.3.4.2.9.2.10.12.8  LIMITATIONS 


None. 


3. 3. 4. 2. 9. 3  PITCH  AUTOPILOT  PACKAGE  DESIGN  (CATALOG  #P307-0) 

This  package  body  implements  the  Pitch  Autopilot  function.  It  contains  the 
instantiation  of  the  Integral  Plus  Proportional  Gain  package  for  the  integrator 
loop  of  the  Normal  Acceleration  error,  as  well  as  subprogram  bodies  for 
operations  declared  in  the  package  specification. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 4. 2. 9. 3.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R059. 


3. 3. 4. 2. 9. 3. 2  LOCAL  ENTITIES  DESIGN 
None. 


3. 3. 4. 2. 9. 3. 3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 
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|  Name 


Type  |  Description 


Normal_Acceleration  |  Generic  Float 
Commands 

Acceleration_Command_  j  Generic  Float 
Gains  j 

Acceleration  Gains  Generic  Float 


Fin  Deflections 


Generic  Float 


Pitch  Rate  Gains 


Generic  Float 


Type  for  input  commands 

Gains  used  in  Integral 
Plus_Proportional_GaTn 

Gains  applied  to 

filtered  acceleration 
feedback 

Type  for  Fin  Deflection 
command 

Gains  applied  to 
filtered  pitch  rate 


Data  objects: 

The  following  table  summarizes  the  generic  formal  objects  required  by  this 
part: 


Initial  Integrator 

Acceleration 

Initial  gain  to 

Gain 

Command_GaTns 

Tustin  integrator 
input 

Initial  Integrator 

Fin  Deflections 

Initial  limit  on 

Limit 

Tustin  integrator 
output 

Initial  Acceleration 

Acceleration  Gains 

Initial  gain  to 

Gain 

filtered  accelera¬ 
tion  feedback 

Initial  Pitch  Rate 

Pitch  Rate  Gains 

Initial  gain  to 

•  Gain 

filtered  pitch 
rate  feedback 

Initial  Proportional 

Acceleration 

Initial  proportional 

Gain 

Command_GaIns 

gain  for  integral 
loop 

3. 3. 4. 2. 9. 3. 4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

|  Pitch  Rate  Gain 

i 

|  Acceleration_Gain 


I  Type 

|  Pitch  Rate  Gains 

I  "  " 

|  Acceleration_Gains 


!  Description 


Pitch  rate  feedback 
gain 

Accel,  feedback 
gain 
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3. 3. 4. 2. 9. 3. 5  PROCESS  CONTROL 


Not  applicable. 


3. 3. 4. 2. 9. 3. 6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

with  Signal_Processi.ng; 

separate  (Autopilot) 

package  body  Pitch_Autopilot  is 

AccelerationGain  :  Acceleration_Gains  Initial_Acceleration_Gain; 

Pitch_Rate_Gain  :  Pitch_Rate_Gains  Initial_Pitch_Rate_Gain; 

package  Tustin_Integrator  is  new 

Signal_Processing.Tustin_Integrator_With  Limit 

(Signals  ->  Normal  AcceIeration_Commands, 

States  =*>  Fin_De?lections, 

Gained_Signals  ->  Fin  Deflections, 

Gains  «>  Acceleration_Coramand_Gains , 

Initial_Tustin_Gain  ■>  Initial_Integrator_Gain, 
Initial_Signal_Level  ->  0.0, 

Initial_Signal_Limit  ->  Initial_Integrator_Limit); 

package  Pitch  Loop_Integral_Plus  Proport ional  Gain  is  new 
In  tegral_Plus_Propor  t  ional_GaIn 

(InputSignals  »>  NormalAcceleration  Commands, 

Gains  *>  Acceleration_Comman9_Gains, 

Integrated_Signals  ->  Fin_Def lections, 

InitialProportionalGain  ->  Initial  Proport ionalGain, 

Tustin_Integrate  ->  Tustin_Integrator. Integrate) ; 

package  Pitch_Loop  renames  Pitch_Loop_Integral_Plus_Proportional_Gain; 

4  “ 

end  PitchAutopilot; 


3. 3. 4. 2. 9. 3. 7  UTILIZATION  OF  OTHER  ELEMENTS 

The  following  library  units  are  with'd  by  this  part: 

1.  Signal  Processing 

UTILIZATION  OF  EXTERNAL  ELEMENTS: 

Packages : 

The  following  table  summarizes  the  external  packages  required  by  this  part: 
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|  Name 

|  Type  |  Source  | 

Description  | 

I  Tustin  Integrator 

|  Generic  |  1. 

Exports  integrate  function  | 

j  With  Limit 

|  Package | 

for  Integral  Plus  Propor-  j 

1 

1  1 

1 

tional_Gain  Instantiation  j 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type 

|  Source  | 

Description  | 

I  Integral  Plus  Proportional 

|  Generic 

|  Package  | 

Performs  integrator 

j  Gain 

j  Package 

Spec,  j 

function  on  normal 

1 

1 

1  1 

acceleration  error 

3. 3. 4. 2. 9. 3. 8  LIMITATIONS 


None. 


3. 3. 4. 2. 9. 3. 9  LLCSC  DESIGN 


None. 


3.3.4.2.9.3.10  UNIT  DESIGN 

3.3.4.2.9.3.10.1  INITIALIZE_PITCH_AUTOPILOT  UNIT  DESIGN 
Initializes  state  of  integrator  in  pitch  control  loop. 


3.3.4.2.9.3.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R053  (2). 


3.3.4.2.9.3.10.1.2  LOCAL  ENTITIES  DESIGN 


None. 
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3.3.4.2.9.3.10.1.3  INPUT/OUTPUT 
None. 

3.3.4.2.9.3.10.1.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type  | 

Description  | 

|  Gained  Signal 

|  Fin  Deflections | 

Value  of  acceleration  command  | 

1 

1  1 

after  applying  gain  j 

|  Intitial_State 

|  Fin_Deflections| 

Output  state  of  integrator  loop  j 

3.3.4.2.9.3.10.1.5  PROCESS  CONTROL 


Not  applicable. 


3.3.4.2.9.3.10.1.6  PROCESSING 

The  folloving  describes  the  processing  performed  by  this  part: 

procedure  Initialize_Pitch_Autopilot 

(Normal  Acceleration  Command  :  in  Normal_Acceleration_Commands; 

Measure3_Normal  Acceleration  :  in  Accelerations; 

Measured_Pitch_Rate  :  in  Pitch_Rates; 

Initial_Slevator_Command  :  in  Fin_Deflections)  is 

Gained_Signal  :  Fin_Deflections; 

Initial_State  :  Fin_Deflections; 

begin 

GainedSignal  :■  (-  Normal_Acceleration_Command  + 

Measured-Normal  Acceleration)  * 

In i t ial_Fropo  r  tIonal_Gain ; 


Initial_State  :- 

~  Gained_Signal  + 

Measured_Normal_Acceleration  *  Acceleration_Gain  - 
Measured_Pitch_Rate  *  Pitch_Rate_Gain  + 
Initial_Elevator_Coramand; 

Tustin_Integrator. Reset  (Integrator_State  ->  Initial_State, 

Signal  -> 

Normal_Acceleration_Commands  (0.0)  ) ; 

end  Initialize_Pitch_Autopilot; 
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3.3.4.2.9.3.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name 

Type 

Source 

Description  | 

|  Reset 

Procedure 

Tustin_Integrator 
from  package  body 

Resets  state  of 
integrator 

|  %" 

1 

Function 

Generic  Package  Spec 

Adds  acceleration  cmd 
and  measured  accel¬ 
eration  feedback 

1 

1 

Function 

Generic  Package  Spec 

Times  for  applying 
gain  to  accelera¬ 
tion  command 

1 

Function 

Generic  Package  Spec 

Times  for  applying 
gain  to  accelera¬ 
tion  feedback 

j 

i 

1 

Function 

Generic  Package  Spec 

Times  for  applying 
gain  to  pitch  rate 
feedback 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
ancestral  units: 


|  Name 

Type 

Source 

Description  | 

1  Normal  Accelera 

Generic 

Generic  Pkg 

Type  for  input  acceleration 

j  tion  Commands 

Float 

Spec 

command 

j  Accelerations 

Generic 

Generic  Pkg 

Type  for  acceleration 

1 

Float 

Spec 

feedbacks 

|  Pitch  Rates 

Generic 

Generic  Pkg 

Type  for  pitch  rate 

Float 

Spec 

feedback 

j  Fin  Deflections 

Generic 

Generic  Pkg 

Data  type  for  state  of 

Float 

Spec 

integrator 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined 
elsewhere  in  the  parent  top  level  component: 
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1 

Name  | 

Type  | 

Source  | 

Description  | 

! 

Initial  Integrator! 

Acceleration  | 

Package | 

Gain  applied  to  | 

1 

Gain 

Command  Gains | 

Body  | 

acceleration  error  j 

1 

Acceleration  Gain  j 

Acceleration  j 

Package | 

Gain  applied  to  | 

1 

Gains  i 

Body  j 

acceleration  feedback! 

1 

Pitch  Rate  Gain  ! 

Pitch  Rate  i 

Package | 

Gain  applied  to  pitch  j 

1 

Gains 

Body  j 

rate  feedback  j 

3.3.4.2.9.3.10.1.8 


LIMITATIONS 


None. 


3.3.4.2.9.3.10.2  COMPUTE_ELEVATOR_COMMAND  UNIT  DESIGN 
Computes  elevator  fin  deflection  command. 


3.3.4.2.9.3.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R053  (2). 


3.3.4.2.9.3.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.3.10.2.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name  |  Type  |  Description  | 


j  Normal_Acceleration 
1  Command 
j  Measured_Normal_ 
j  Accelerations 
j  Measured_Pitch_Rate 

<return  value> 


Normal_Acceleration 

Commands 

Accelerations 

Pitch_Rates 

Fin  Deflections 


Input  command  from 
guidance  system 

Measured  acceleration 
feedback 

Measured  pitch  rate 
feedback 

Elevator  Command 


3.3.4.2.9.3.10.2.4  LOCAL  DATA 


Data  objects: 
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The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name  |  Type  |  Description 


Filtered_Normal_ 
Acceleration 
Normal  Accel- 
eratIon_Error 

Integral_Output 

Filtered_Pitch_ 

Rate 

Limi ted_Elevator 
Command 


Accelerations 

Normal_Acceler- 

ation_Commands 

Fin_Deflections 

Pitch_Rates 

Fin  Deflections 


Value  of  acceleration  feedback 
after  applying  filter 
Difference  between  input  accel¬ 
eration  command  and  filtered 
acceleration  feedback 
Output  state  of  integrator  loop 
Value  of  pitch  rate  feedback 
after  applying  filter 
Output  value  from  Compute_ 
Elevator  Command 


3.3.4.2.9.3.10.2.5  PROCESS  CONTROL 
Not  applicable. 


3.3.4.2.9.3.10.2.6  PROCESSING 


The  following  describes  the  processing  performed  by  this  part: 

function  ComputeElevatorCommand 

(Normal_Acceleration_Command  :  in  NormalAccelerationCommands; 
Measured_Normal  Acceleration  :  in  Accelerations; 
Measured~Pitch_Rate  :  in  Pitch_Rates) 

return  Fin  Deflections  is 


F i 1 1 e r ed_Normal_Ac ce le r a t  i  on 
Normal_Acceleration_Error 
Integral_Output 
Filtered_Pitch_Rate 
Limited  Elevator  Command 


Accelerations; 

Normal  Acceleration_Commands; 
Fin_DeIlec  t ions ; 

Pitch_Rates; 

Fin  Deflections; 


begin 


Filtered_Normal_Acceleration  Acceleration_Filter  (Measured_Normal_Acceleration 

Normal_Acceleration_Error  :-  Normal_Acceleration_ Command  - 

Filtered  Normal  Acceleration; 


Integral_Output  :-  Pi tch_Loop. Integrate  (Normal_Acceleration_Error) ; 
Filtered_Pitch_Rate  :■  Pitch_Rate_Filter  (Measured_Pitch_Rate) ; 


Limited_Elevator  Command  := 

Limit  (Integral_Output  - 

Filtered~Normal_Acceleration  *  Acceleration_Gain  + 
Filtered  Pitch  Rate  *  Pitch  Rate  Gain); 


return  (Limited  Elevator  Command); 
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end  Compute  Elevator_Command; 


3.3.4.2.9.3.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type  | 

Source 

|  Description  | 

|  Pitch  Loop  Integral 
j  Plus  Proportional 

Gain  (renamed: 
i  Pitch_Loop) 

|  Package | 

1  1 

1 

1  1 

Package 

Body 

|  Implements  integrator  | 
loop  fcr  normal 
i  acceleration  error  j 

1  I 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsevhere  in  the  parent  top  level  component: 


|  Name 

Type 

Source 

Description  | 

Acceleration 

Function 

Generic  Pkg 

Performs  filter  function  on 

Filter 

Spec 

Acceleration  feedback 

W_.lt 

Function 

Generic  Pkg 
Spec 

Minus  for  calculating 
normal  acceleration  error 
in  integral  loop 

Integrate 

Function 

Pitch  Loop 
package 
in  body 

Performs  integral  plus 
proportional  gain  function 

Pitch  Rate 

Function 

Generic  Pkg 

Performs  filter  function  on 

Filter 

Spec 

pitch  rate  feedback 

Limit 

Function 

Generic  Pkg 
Spec 

Performs  Limiter  function 
(e.g.  R202) 

"*« 

Function 

Generic  Pkg 
Spec 

Times  for  applying  gain  to 
acceleration  feedback 

***** 

Function 

Generic  Pkg 
Spec 

Times  for  applying  gain  to 
Pitch  Rate  feedback 

Data  types: 

The  following  table  summarizes  the  data  types  required  by  this  part  and  defined 
elsewhere  in  the  parent  top  level  component: 
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|  Name 

Type 

|  Source  | 

Description 

1 

|  Normal  Acceleration 

Generic 

| Generic  ' 

Type  for  input  commands 

j  Commands 

Float 

j  Pkg  Spec  j 

|  Accelerations 

Generic 

| Generic 

Type  for  acceleration 

Float 

j  Pkg  Spec j 

feedbacks 

|  Pitch  Rates 

Generic 

j Generic  j 

Type  for  pitch  rate 

Float 

j  Pkg  Spec | 

feedback 

|  Fin  Deflections 

Generic 

j Generic  j 

Type  for  Fin  Deflection 

Float 

j  Pkg  Specj 

output 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type 

|  Source  | 

Description  | 

Acceleration  Gain  | 

|  Acceleration 

Package) 

Gain  applied  to  j 

! 

i  Gains 

Body  j 

acceleration  feedback! 

Pitch  Rate  Gain 

‘ 

j  Pitch_Rate_ 
j  Gains 

Package  j 
Body  j 

Gain  applied  to  pitch  j 
rate  feedback  1 

3.3.4.2.9.3.10.2.8  LIMITATIONS 


None. 


3.3.4.2.9.3.10.3  UPDATE_PITCH_RATE_GAIN  UNIT  DESIGN 
Updates  the  current  value  of  the  Pitch  Rate  Gain 


3.3.4.2.9.3.10.3.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R053. 


3.3.4.2.9.3.10.3.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.3.10.3.3  INPUT/OUTPUT 


GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 
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* 


|  Name 

1  Type 

Description  | 

|  Pitch  Rate  Gains 

|  Generic  Float 

Gains  applied  to 

1 

1 

filtered  pitch  rate  | 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name  | 

Type 

|  Description  | 

|  New  Gain  | 

1  '  1 

Pit  ch_Ra  t  e_Ga ins 

|  New  value  for  Gain  applied 
i  to  filtered  pitch  rate 

3.3.4.2.9.3.10.3.4 

LOCAL  DATA 

None. 

3.3.4.2.9.3.10.3.5 

PROCESS  CONTROL 

Not  applicable. 

3.3.4.2.9.3.10.3.6 

PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Pitch_Rate_Gain  (Nev_Gain:  in  Pitch_Rate_Gains)  is 
begin 

Pitch_Rate_Gain  :-  New_Gain; 
end  Update_Pitch_Rate_Gain; 

3.3.4.2.9.3.10.3.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined 
elsewhere  in  the  parent  top  level  component: 

i 
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|  Name 

1  Type  | 

Source  | 

Description  | 

|  Pitch  Rate  Gain 

|  Pitch  Rate  Gainst 

Package  | 

Pitch  rate  feedback  j 

1 

1  1 

Body  | 

gain  j 

3.3.4.2.9.3.10.3.8  LIMITATIONS 


None. 


3.3.4.2.9.3.10.4  UPDATE_ACCELERATION_GAIN  UNIT  DESIGN 
Updates  the  current  value  of  the  Acceleration_Gain 


3.3.4.2.9.3.10.4.1  REQUIREMENTS  ALLOCATION 
This  part:  meets  CAMP  requirement  R053. 


3.3.4.2.9.3.10.4.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.3.10.4.3  INPUT/OUTPUT 


GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Acceleration  Gains 

|  Generic  Float 

|  Gains  applied  to  i 

1 

1 

filtered  acceleration  j 

1 

1 

i  feedback  j 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  New  Gain 

|  Acceleration 

|  New  value  for  Gain  applied  | 

i 

|  Gains 

1  to  filtered  acceleration  j 

1 

1 

j  feedback  j 
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3.3.4.2.9.3.10.4.4  LOCAL  DATA 


None. 


3.3.4.2.9.3.10.4.5  PROCESS  CONTROL 


Not  applicable. 


3.3.4.2.9.3.10.4.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update  Acceleration_Gain  (New_Gain:  in  Acceleration_Gains)  is 
begin 

Acceleration_Gain  :*  New_Gain; 
end  Update_Acceleration_Gain; 


3.3.4.2.9.3.10.4.7  UTILIZATION  OP  OTHER  ELEMENTS 
UTILIZATION  OP  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type 

|  Source  | 

Description  | 

|  Acceleration 

|  Acceleration 

|  Package  | 

Acceleration  feedback  | 

j  Gain 

\  Gains 

!  Body  j 

gain  j 

3.3.4.2.9.3.10.4.8  LIMITATIONS 


None. 


3.3.4.2.9.3.10.5  UPDATE_INTEGRATOR_GAIN  UNIT  DESIGN 
Updates  the  current  value  of  the  Integrator_Gain 


< 
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3.3.4.2.9.3.10.5.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R053. 

3.3.4.2.9.3.10.5.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.4.2.9.3.10.5.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name  | 

1  Type 

|  Description  | 

|  Acceleration 
j  Command_GaIns 

Generic  Float 

|  Gains  applied  to 

acceleration  commands  j 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  New  Gain 

1 

|  Acceleration 
j  Command_GaIns 

|  New  value  for  Gain  applied  | 
to  acceleration  commands  j 

3.3.4.2.9.3.10.5.4  LOCAL  DATA 
None. 

3.3.4.2.9.3.10.5.5  PROCESS  CONTROL 
Not  applicable. 

3.3.4.2.9.3.10.5.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Integrator_Gain  (New_Gain:  in  Acceleration_Command_Gains)  is 
begin 

Tustin_Integrator.Update_Gain  (New_Gain  ->  New_Gain); 
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end  Update_Integrator_Gain; 


v 

*> 


3.3.4.2.9.3.10.5.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type  | 

Source 

|  Description  | 

|  Tustin  Integrator 

|  Package | 

Package 

|  Implements  integrator  | 

1 

1  1 

Body 

i  function  in  pitch 

1 

1  1 

loop  function  j 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsevhere  in  the  parent  top  level  component: 


|  Name 

Typ* 

Source 

|  Description  | 

|  Update  Gain 

Procedure 

Pitch  Loop 

|  Updates  integrator  gain  [ 

1 

package 

j  in  pitch  loop  function  \ 

1 

in  body 

1  1 

3.3.4.2.9.3.10.5.8  LIMITATIONS 


None. 


3.3.4.2.9.3.10.6  UPDATE_INTEGRATOR_LIMIT  UNIT  DESIGN 
Updates  the  current  value  of  the  Integrator_Lioit 


3.3.4.2.9.3.10.6.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R053. 


3.3.4.2.9.3.10.6.2  LOCAL  ENTITIES  DESIGN 


None. 
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3.3.4.2.9.3.10.6.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Fin  Deflections 

|  Generic  Float 

|  Value  for  fin  deflection | 

1 

! 

output  from  package  j 

FORMAL  PARAMETERS: 

The  following  table  summarizes  the  formal  parameters  required  by  this  part: 


|  Name 

1  Type 

[  Description  | 

|  New  Limit  | 

1  '  1 

|  Fin_De€lections 

|  New  value  for  limit  on  | 

j  fin  deflection  output 

3.3.4.2.9.3.10.6.4 

None. 

LOCAL  DATA 

3.3.4.2.9.3.10.6.5 

Not  applicable. 

PROCESS  CONTROL 

3.3.4.2.9.3.10.6.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Integrator_Limit  (Nev_Limit:  in  Fin_Deflections) 

begin 


Tustin_Integrator.Update_Limit  (New_Absolute_Limit  ->  New_Limlt); 
end  Update_Integrator_Limit; 

3.3.4.2.9.3.10.6.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 


v 


/ 
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Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type  | 

Source 

|  Description  | 

|  Tustin  Integrator 

|  Package | 

Package 

|  Implements  integrator  1 

1 

Body 

j  function  in  pitch  j 

1 

1  1 

j  loop  function  j 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type 

j  Source  | 

|  Description  | 

|  Update  Limit 

| Procedure 

|  Pitch  Loop  | 

{  Updates  integrator  limit 

1 

|  package  j 

in  pitch  loop  function  j 

1 

1  1 

in  body 

1  1 

3.3.4.2.9.3.10.6.8  LIMITATIONS 


None. 


3.3.4.2.9.3.10.7  UPDATEPROPORTIONALGAIN  UNIT  DESIGN 
Updates  the  current  value  of  the  Proporational_Gain 


3.3.4.2.9.3.10.7.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R053. 


3.3.4.2.9.3.10.7.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.4.2.9.3.10.7.3  INPUT/OUTPUT 


GENERIC  PARAMETERS: 

Data  types: 

The  following  table  summarizes  the  generic  formal  types  required  by  this  part: 
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|  Name 

1  Type 

|  Description  | 

|  Acceleration_Command_  |  Generic  Float  |  Gains  applied  to  normal  | 
j  Gains  j  j  acceleration  commands  j 

FORMAL  PARAMETERS: 

The  following  table 

summarizes  the 

formal  parameters  required  by  this 

|  Name  | 

Type 

|  Description  | 

|  New  Proportional | 
j  Gain  j 

1  "  1 

Acceleration 

Command_GaIns 

|  New  value  for  Gain  applied  | 
i  to  Normal_Acceleration_  j 
j  Commands  j 

3.3.4.2.9.3.10.7.4  LOCAL  DATA 
None. 

3.3.4.2.9.3.10.7.5  PROCESS  CONTROL 
Not  applicable. 

3.3.4.2.9.3.10.7.6  PROCESSING 


The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Proportional  Gain 

(Nev_Proportional_GaTn  :  in  Acceleration_Command_Gains)  is 


begin 

PitchLoop.UpdateProportional  Gain 

(New_Proportional_Gain  ->  New_Proportional_Gain); 

end  Update_Proportional_Gain; 


3.3.4.2.9.3.10.7.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Packages : 

The  following  table  summarizes  the  packages  required  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 
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|  Name 

Type  | 

Source 

|  Description  j 

|  Pitch_Loop  Integral_ 
Plus  Proportional_ 
j  Gain  =  Pitch_Loop- 

Package | 

1 

1 

Package 

Body 

|  Implements  integral 
plus  propoL tional 
[  gain  in  pitch  loop 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name 

I  Type  | 

Source 

|  Description  | 

|  Update 

(Procedure  | 

Pitch  Loop 

Updates  proportional  gain 

j  Proportional 

i  1 

paclcage 

in  pitch  loop  function 

j  Gain 

1  1 

in  body 

3.3.4.2.9.3.10.7.8  LIMITATIONS 
None. 

3.3.4.2.10  UNIT  DESIGN 
None. 
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package  body  Autopilot  is 

package  body  Integral_Plus_Proportional_Gain  is  separate 
package  body  Pitch_Autopilot  is  separate; 
package  body  Lateral_Directional_Autopilot  is  separate; 
end  Autopilot; 
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separate  (Autopilot) 

package  body  Integral_Plus_Proportional_Gain  is 

Proportional_Gain:  Gains  :=  Initial_Proportional_Gain; 

pragma  PAGE; 

function  Integrate  (Signal:  Input_Signals)  return  Integrated_Signals  is 

begin 

return  (Tustin_Integrate  (Signal)  +  Signal  *  Proportional_Gain) ; 
end  Integrate; 
pragma  PAGE; 

procedure  Update_Proportional_Gain  (Nev_Proportional_Gain  :  in  Gains)  is 
begin 

Proportional_Gain  New_Proportional_Gain; 
end  Update_Proportional_Gain; 
end  Integral  Plus  Proportional  Gain; 
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vith  Signal_Processing; 
separate  (Autopilot) 

package  body  Lateral  Directional  Autopilot  is 


—  — Initial  vaules  for  Aileron  Control  Loop 

Aileron_Cmd_Roll_Rate_Gain  : 

Aileron_Cmd_Yav_Rate_Gain  : 

—  —  Initial  values  for  rudder  control  loop 

Rudder_Cmd_Roll_Rate_Gain  s 

Rudder  Cmd  Feedback  Rate  Gain  : 


Feedback_Rate  Gains  :* 

Initial  RoIl_Rate  Gain_For_Aileron; 
Feedback_Rate_Gains  :■ 

Initial  Yaw  Rate  Gain  For  Aileron; 


Rudder_Cmd_Roll_Rate_Gains  :« 

Ini  t  ial_Roll_Rate~Gain_For_Rudder ; 
Feedback_Rate_Gains 

Initial  Yaw  Rate  Gain  For  Rudder; 


—  Packages  for  Aeliron  control  loop 


package  Aileron_Cmd_Tustin_Integrator  is  nev 

Signal_Processing.Tustin_Integrator_Vith  Limit 


AT 


(Signals 
States 

GainedSignals 

Gains 

Initial_Tustin_Gain 
Initial_Signal_Level 
Initial  Signal  Limit 


■>  Roll  Commands, 

->  Fin_Deflections, 

■>  Fin~Deflections, 

»>  Roll  CommandGains , 

»>  Ini tTal_Aileron_Integrator_Gain, 

->  0.0,  " 

->  Initial_Aileron_Integrator_Limit); 


package  Aileron_Cmd_Integral  Plus_Proportional_Gain  is  nev 
Integral_Plus_ProportionaI_Gain 


(Input_Signals 
Gains 

IntegratedjSignals 
Initial  Proportional_Gain 
Tustin  Integrate 


->  Roll_Commands , 

«>  Roll_Command_Gains, 

■>  Fin_Sef lections, 

->  Initial_Roll  Command_Proportional_Gain, 

■>  Aileron_CmdJfustin_Integrator.  Integrate) ; 


package  Aileron_Loop  renames  Aileron_Cmd_Integral_Plus_Proportional_Gain; 

—  Packages  for  rudder  control  loop 

package  Rudder_Cmd_Tustin  Integrator  is  nev 

Signal_ProcessIng.Tustin_Integrator_With_Limit 

~  Missile  Accelerations, 

F i n_De f Tec t i ons , 

Fin_Deflections, 
Acceleration_Gains, 

Initial  Ruddir_Integrator_Gain, 

0.0,  “ 

Initial  Rudder  Integrator  Limit); 


(Signals  -> 
States  «> 
Gained_Signals  -> 
Gains  «> 
Initial_Tustin_Gain  ■> 
Initial_Signal_Level  ■> 
Initial  Signal  Limit  => 


v.xV 


package  Rudder_Cmd_Integral_Plus  Proportional_Gain  is  nev 
In  t  egral_Plus_Pr  opor  t  i  onal_GaIn 

(Input_Signals  ”  ->  Missile_Accelerations, 

Gains  «>  Acceleration_Gains, 

Integrated  Signals  ->  Fin  Deflections, 
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Initial_Proportional_Gain  =>  Initial_Acceleration_Proportional_Gain, 
Tustin_Integrate  =>  Rudder_Cmd_Tustin_Integrator. Integrate) ; 

package  Rudder  Loop  renames  Rudder_Cmd_Integral_Plus_Proportional_Gain; 


procedure 


pragma  PAGE; 


Initialize  Lateral_Directional 
(Ini t iaI_Ai leron_Command 
In i t i al_Rudder_Command 
Gravitational_Acceleration 
Roll_Command 
Roll~Attitude 
Roll~Rate 
Yaw_Rate 
Missile_Velocity 
Lateral  Acceleration 


Autopilot 

in  Fin_Deflections; 
in  Fin-Def lections; 
in  Gravitational_Accelerations; 
in  Roll_Commands7 

in  Roll  Attitudes; 
in  FeedSack_Rates; 
in  Feedback_Rates; 
in  Velocities; 

in  Missile  Accelerations)  is 


Gained  Roll  Command  Signal  :  FinJDeflections; 


Initial  Aileron  State  :  Fin  Deflections; 


Initial_Rudder_State  s  Fin_Def lections; 

begin 


GainedRollCommandSignal  :» 

(Roll_Conunand  -  RollAttitude)  * 

In  i  t  i  al_Ro  1  l_Command_Propor  t  i  onal_Ga  in ; 

InitialAileron  State  :* 

Initial  AileronCommand  - 
Gained_Roll_Command  Signal  + 

Yaw  Rate  *  Aileron_Cmd  Yaw_Rate_Gain  + 

Roll  Rate  *  Aileron_Cm3_Yaw_Rate_Gain; 

Initial_Rudder_State  :■ 

Initial_Rudder_Comraand  - 
(YawRale  - 

(Gravi tational_Acceleration  *  Sin  (Roll_Attitude) 

/  MisIile_Velocity)  - 
(Roll  Rate  *  Rudder_Cmd  Roll_Rate_Gain) 

)  *  Ru3der_Cmd_FeedbacK_Rate_Gain  - 

Lateral_Acceleration  *  Tnitial_Acceleration_Proportional_Gain; 

Aileron_Cmd_Tus  t  in_Integrator .  RESET 

(Integrator_State  ■>  Initial_Aileron_State, 

Signal  ->  0.0); 


Rudder_Cmd_Tus  t  in_In  tegrat  or .  RESET 

(Integrator_State  =>  Initial_Rudder_State, 
Signal  =>  0.0); 


end  Initialize  Lateral  Directional  Autopilot; 


f unc  t  ion  Compu  t  e_Ai  ler on_Rudder_Commands 


pragma  PAGE; 
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(Roll  Command 

in  Roll_Commands ; 

Roll_Attitude 

in  Roll  Attitudes; 

Roll_Rate 

in  FeedEack_Rates; 

Yaw_Rate 

in  Feedback_Rates; 

Lateral_Acceleration 

in  Missile  Accelerations; 

Missile~Velocity 

in  Velocities; 

Gravitational  Acceleration 

in  Gravitational  Accelerations) 

return  Aileron  Rudder  Commands  is 


Fi 1 t ered_Roll_Command 
Roll_Error 

Aileron  Integral_Output 
Fi  1  tere<I_Yav_Rate 
Filtered_Lateral_Acceleration 
Rudder_Integral_Output 
Fin  Command 


Roll_Commands ; 
Roll_Commands ; 

Fin  Deflections; 
Fee3back_Rates; 

Missile  Accelerations; 
Fin_DefIections; 

Aileron  Rudder  Commands; 


begin 


— Aileron  command  computations 

Filtered_Roll_Command  :■  Roll  Command_Filter  (Roll  Command); 

RollError  Filtered_Roll_Command  -  Roll_Attitude; 

RollError  j-  Roll_Error_Limit  (Roll_Error) ; 

Aileron_Integral_Output  AileronLoop. Integrate  (Roll_Error); 

Filtered_Yaw_Rate  j-  Yav_Rate_Filter  (Yaw_Rate); 

Fin_Command. Aileron  Command 

Aileron_Command_Eimit  (Aileron  Integral_Output  - 

Filtere<I_Yav  Rate  *  Aileron  Cmd_Yav_Rate_Gain  - 
Roll  Rate  *  Sileron  Cmd  Roll  Rate  Gain); 


—  Rudder  command  computations 

Filtered_Lateral_Acceleration  s« 

Acceleration_Filter  (LateralAcceleration); 

Rudder_Integral_Output  :■  Rudder  Loop. Integrate 

(FiItered_Lateral_Acceleration); 


Fin_Command.Rudder_Command 
Rudder_Command_Eimi t 

(Rudder_Integral_Output  + 

(Filtered_Yaw_Rate  - 

(GravitationIl_Acceleration  *  Sin  (Roll_Attitude)  / 
Missile_Velocity)  - 

Roll_Rate  *  Rudder  Cmd_Roll  Rate_Gain)  * 

Rudder  Cmd_FeedbacIt_Rate  Gain 

); 

return  (Fin_Command) ; 
end  Compute_Aileron_Rudder_Commands; 
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pragma  PAGE; 

procedure  Update_Aileron  Integrator_Gain 

(Nev_Gain:  In  Roll_Cominand_Gains)  is 

begin 

Aileron_Cmd_Tustin_Integrator.Update_Gain  (New_Gain  ■>  New_Gain); 
end  Update_Aileron_Integrator_Gain; 


procedure  Update_Aileron_Integrator  Limit 

(Nev_Limit  :  in  Fin_DeIlections)  is 


begin 

Aileron_Cmd_Tustin_Integrator.Update_Limit 
(New_Absolute_Limit  «>  Nev~Limit); 

end  Update_Aileron_Integrator_Limi t ; 

procedure  Update_Roll_Command  Proportional  Gain 

(New_Gain:  in  RoIl_Comiaand_GaIns)  is 


pragma  PAGE; 


pragma  PAGE; 


begin 

Aileron_Loop.Update_Proportional_Gain  (Nev_Proportional_Gain  ->  NevGain); 
end  Update_Roll_Command_Proportional_Gain; 


procedure  Update_Roll_Rate_Gain  For  Aileron 

(Nev  Gain  :  in  Fee?badt  Rate  Gains)  is 


pragma  PAGE; 


begin 

Aileron_Cmd_Roll_Rate_Gain  New_Gain; 

end  Update_Roll_Rate_Gain_For_Aileron; 

procedure  Update  Yaw_Rate_Gain_For_Aileron 

(Nev_GaIn  :  in  Feedback_Rate_Gains)  is 


pragma  PAGE; 


begin 

Aileron_Cmd_Yav_Rate_Gain  :■  Nev_Gain; 
end  Update_Yaw_Rate_Gain  For  Aileron; 


procedure  Update  Rudder_Integrator_Gain 

(New_GaIn  :  in  Acceleration_Gains)  is 


pragma  PAGE; 


begin 

Rudder_Cmd_Tustin_Integrator.Update_Gain  (Nev_Gain  ->  Nev_Gain); 
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end  Update_Rudder_Integrator_Gain; 

procedure  Update_Rudder_Integrator_Limi  t 

(Nev_Limit  :  in  Fin_Def lections)  is 


pragma  PAGE; 


begin 

Rudder_Cmd_Tus  t  in_In  tegrator .  Update_Limi  t 

(New_Absolute_Limit  ->  New_Limit); 

end  Update_Rudder_Integrator_Limit; 

pragma  PAGE; 

procedure  Update_Feedback  Rate_Gain  For_Rudder 

(New_Gain  :  In  Feedbaclt_Rate_Gains)  is 

begin 

Rudder_Cmd_Feedback_Rate_Gain  :*  New_Gain; 
end  Update  Feedback  Rate_Gain  For  Rudder; 


pragma  PAGE; 

procedure  Update_Roll_Rate_Gain  For  Rudder 

(NevGain  s  in  Rudle  r_Cmd_Ro  1  l_Ra t e_Ga ins)  is 

begin 

Rudder_Cmd_Roll_Rate_Gain  Nev  Gain; 
end  Update_Roll_Rate_Gain_For_Rudder ; 

pragma  PAGE; 

procedure  Update_Acceleration_Proportional_Gain 

(Nev_Gain  :  in  Acceleration_Gains)  is 

begin 

Rudder_Loop.Update_Proportional_Gain  (Nev_Proportional_Gain  ■>  Nev  Gain); 
end  Update_Acceleration_Proportional_Gain; 


end  Lateral_Directional_Autopilot ; 
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with  Signal_Processing; 

separate  (Autopilot) 

package  body  Pitch_Autopilot  is 

Acceleration_Gain  :  Acceleration_Gains  :=  Initial_Acceleration_Gain; 
Pitch  Rate  Gain  :  Pitch  Rate  Gains  :=  Initial  Pitch  Rate  Gain; 


package  Tustin_Integrator  is  new 

Signal_Processing.Tustin 

(Signals 

States 

Gained_Signals 

Gains 

Initial_Tustin_Gain 

Initial_Signal_Level 

Initial_Signal_Limit 


Integrator_With  Limit 
■>  Normal  AcceIeration_Commands, 
■>  Fin_De?lections, 

*>  Fin_Deflections, 

»>  Acceleration_Command_Gains, 

->  InitiallntegratorGain, 

0.0, 

->  Initial_Integrator_Limit); 


package  Pitch  Loop_Integral_Plus  Proport ional_Gain  is  nev 
Integral_PTus_Propor  tional_GaIn 

(Input  Signals  »>  Normal_Accelaration  Commands, 

Gains  ■>  Acceleration_Comman3_Gains, 

Integrated_Signals  ■>  Pin_Def lections, 

Initial  Proportional_Gain  ■>  Initial  Proportional_Gain, 

Tustinlntegrate  ■>  Tustinlntegrator. Integrate); 

package  PitchLoop  renames  Pitch_Loop_Integral_Plus_Proportional_Gain; 


procedure  Initiali ze_P i t ch_Au t opi lo t 

(Normal  Acceleration  Command  : 
Measure3_Normal  Acceleration  : 
Measured_Pitch_Rate  : 
Initial  Elevator  Command  : 


pragma  PAGE; 

in  Normal_Acceleration_Commands; 
in  Accelerations; 
in  Pitch_Rates; 
in  Fin  Deflections)  is 


Gained_Signal  :  Fin_De  fleet  ions; 
Initial  State  :  Fin  Deflections; 


begin 


Gained_Signal  :■  (-  Normal_Acceleration_Command  + 
Measured_Normal  Acceleration)  * 
Initial_ProportTonal_Gain; 

Initial_State 

Gained_Signal  + 

Measured_Normal_Acceleration  *  Acceleration_Gain  - 
Measured_Pitch_Rate  *  Pitch_Rate_Gain  + 

Initial  Elevator  Command; 


Tustin_Integra tor. RESET  (Integrator_State  ->  Initial_State, 

Signal  ”  »> 

Normal_Acceleration_Commands  (0.0)); 

end  Initialize_Pitch_Autopilot; 
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function  Compute_Elevator_Command 

(Normal_Acceleration_Command  : 
Measured_Normal_Acceleration  : 
Measured  Pitch_Rate  : 

return  Fin  Deflections  is 


pragma  PAGE; 

in  Normal_Acceleration_Commands; 
in  Accelerations; 
in  Pitch  Rates) 


Filtered_Normal_Acceleration  :  Accelerations; 

Normal_Acceleration_Error  :  Normal  Acceleration_Commands; 

Integral_Output  :  Fin_DeIlections; 

Filtered_Pitch_Rate  :  Pitch_Rates; 

Limited_Elevator_Command  :  Fin_Def lections; 

begin 

Filtered_Normal_Acceleration  :■  Acceleration_Filter  (Measured_Normal_Acceleration 

Normal_Acceleration_Error  Normal_Acceleration_Command  - 

Filtered_Normal_Acceleration; 

Integral_Output  s-  Pi tch_Loop. Integrate  (Normal_Acceleration_Error) ; 

Filtered_Pitch_Rate  s«  Pitch_Rate_Filter  (Measured_Pitch_Rate) ; 

LimitedElevator  Command  :■ 

Limit  (Integral_Output  - 

Filtered_Normal  Acceleration  *  Acceleration  Gain  + 
Filtered~Pitch_5ate  *  Pitch_Rate_Gain) ; 

return  (Limited_Elevator_Command); 

end  Compute_Elevator_Command; 


pragma  PAGE; 

procedure  Update_Pitch_Rate_Gain  (Nev_Gain:  in  Pitch_Rate_Gains)  is 
begin 

Pitch_Rate_Gain  s-  New_Gain; 
end  Update_Pitch_Rate_Gain; 

pragma  PAGE; 

procedure  Update_Acceleration_Gain  (New_Gain:  in  Acceleration_Gains)  is 
begin 

Acceleration_Gain  Nev_Gain; 
end  Update_Acceleration_Gain; 

pragma  PAGE; 

procedure  Update_Integrator_Gain  (New_Gain:  in  Acceleration_Command_Gains)  is 
begin 

Tustin_Integrator.Update_Gain  (New_Gain  ->  New  Gain); 
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end  Update  Integrator  Gain; 


pragma  PAGE ; 

procedure  Update_Integrator_Limit  (New_Limit:  in  Fin_Deflections)  is 

begin 

Tustin_Integrator.Update_Limit  (Nev_Absolute_Limit  ->  New_Limit); 
end  Update_Integrator_Limit; 


pragma  PAGE; 


procedure  Update_Proportional  Gain 

(Nev_Proportional_GaIn  :  in  Acceleration_Command_Gains)  is 


begin 

Pi  tch_Loop.  Update_Propor  tional_Gain 

(Nev_Proportional_Gain  «>  New_Proportional_Gain) ; 

end  Update_Proportional_Gain; 


end  Pitch_Autopilot; 
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3. 3. 5.1  AIR_DATA_PARTS  (PACKAGE  BODY)  TLCSC  P671  (CATALOG  #P316-0) 

This  TLCSC  contains  parts  which  can  be  used  to  monitor  air  conditions. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 5. 1.1  REQUIREMENTS  ALLOCATION 

The  following  chart  summarizes  the  allocation  of  CAMP  requirements  to  this 
part: 


|  Name  |  Requirements  Allocation  | 


|  Compute_Outside_Air_Temperature 

1 

R228 

j  Compute_Pressure_RaIio 

1 

R229 

j  Compute  Mach 

1 

R230 

j  Compute  Dynamic  Pressure 

R231 

j  Compu te_Speed_Of_Sound 

1 

R232 

j  Barometric  Alt! tude_Integrat ion 

1 

R233 

3. 3. 5. 1.2  LOCAL  ENTITIES  DESIGN 
None. 

3. 3. 5. 1.3  INPUT/OUTPUT 
None. 

3.3.5. 1.4  LOCAL  DATA 
None. 

3. 3. 5. 1.5  PROCESS  CONTROL 
Not  applicable. 


3.3.5. 1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

package  body  Air_Data_Parts  is 

f unc t ion  Compu t e_0u ts ide_Ai r_Tempera ture 

(Total_Temperature  :  Temperatures; 

Mach  :  Mach_Numbers) 

return  Temperatures  is  separate; 

function  Compute_Pressure_Ratio 
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(Measured_Static_Pressure  :  Pressures; 

Impact_Pressure  :  Pressures; 

Free_Stream_Static_Pressure  :  Pressures) 
return  Ratios  is  separate; 

function  Compute_Mach 

(Pressure_Ratio  :  Ratios) 
return  Mach_Numbers  is  separate; 

function  Compute_Dynamic_Pressure 

(Free_Stream_Static_Pressure  :  Pressures; 

Mach  ~  :  Mach_Numbers) 

return  Pressures  is  separate; 

function  Compute_Speed_of_Sound 

(Air_Temperature  :  Temperatures) 
return  Velocities  is  separate; 

package  body  Barometric_Altitude_Integration  is  separate; 
end  Air  Data  Parts; 


3. 3. 5. 1.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 


3. 3.5. 1.8  LIMITATIONS 
None. 


3.3.5. 1.9  LLCSC  DESIGN 

3. 3. 5. 1.9.1  BAROMETRIC_ALTITUDE  INTEGRATION  (PACKAGE  BODY)  PACKAGE  DESIGN  (CATALOG 
#P322-0) 

This  unit  is  a  generic  package  which  computes  barometric  altitude  by 
integration  of  the  atmospheric  equation  of  state. 

The  decomposition  for  this  part  is  the  same  as  that  shovn  in  the  Top-Level 
Design  Document. 


3. 3. 5. 1.9. 1.1  REQUIREMENTS  ALLOCATION 
This  parts  meets  CAMP  requirement  R233. 


3.3.5. 1.9. 1.2  LOCAL  ENTITIES  DESIGN 


None. 
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3. 3. 5. 1.9. 1.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name 


Type 


Description 


Temperatures 


floating 
point  tvpe 


Describes  air  temperatures 


Pressures 


floating  |  Describes  pressure  (i.e.  weight  per 
point  type  j  unit  of  area) 


Distances 


floating  j  Describes  translational  distances 
point  type  j  (e.g.,  Feet,  Meters) 


Molar_Gas 

Constants 


floating 
point  type 


Describes  the  type  of  the  Gas  Constant 
needed 


Data  objects: 

The  following  table  describes  the  generic  formal  objects  required  by  this  part: 


|  Name 

1  Type 

|  Value 

|  Description  | 

|Gas  Constant 

1  Molar  Gas 

|  N/A 

| Constant  vhich  describes  a  j 

1 

j Constants 

j standard  gas  constant  j 

!  1 

| Maximum 

| Pressures 

|  N/A 

| Maximum  reasonable  change  1 

j Pressure 

1 

j expected  in  free  stream  static  j 

j  Change 

1 

1 

j pressure  between  two  measurement! 

Subprograms : 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 


|  Name 

1  Type 

Description 

1 

|  »*" 

| function 

Multiplies  the  Gas  Constant  by  a  Pressure 
yielding  a  Distance 

1 

1 

|'V" 

1 

| function 

1 

Divides  a  Temperature  by  a  Pressure, 
yielding  a  Pressure 

1 

1 

1 
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3. 3. 5. 1.9. 1.4  LOCAL  DATA 


None. 


3. 3. 5. 1.9. 1.5  PROCESS  CONTROL 


Not  applicable. 


3. 3. 5. 1.9. 1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
separate  (Air_Data_Parts) 

package  body  Barometric_Altitude_Integration  is 

Previous_Free  Stream_Static_Pressure  :  Pressures  Initial  Free_Stream  Pressure; 

Previous_OutsTde_Air  Temperature  :  Temperatures  InitIal_Temperat"ure; 
Previous_Baro_Altitude  :  Distances  Initial_Baro_Altitude; 

end  Barometric  Altitude  Integration; 


3. 3. 5. 1.9. 1.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 


3. 3. 5. 1.9. 1.8  LIMITATIONS 


None. 


3. 3. 5. 1.9. 1.9  LLCSC  DESIGN 


None. 


3.3.5.1.9.1.10  UNIT  DESIGN 

3.3.5.1.9.1.10.1  COMPUTE_BAROMETRIC_ALTITUDE  UNIT  DESIGN 

This  unit  is  a  function  which  computes  barometric  altitude  by  integration  of 
the  atmospheric  equation  of  state. 


3.3.5.1.9.1.10.1.1  REQUIREMENTS  ALLOCATION 
This  parts  meets  CAMP  requirement  R233. 
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3.3.5.1.9.1.10.1.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.5.1.9.1.10.1.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name  i 

1  1 

Type 

|  Mode 

_  i 

!  Description 

1 

1  1 
|Outside_Air 
j Temperature 

1 

i 

Temperatures |  in 

1 

i 

| Temperature  of  the  air 
| the  missile 

i 

outside 

1 

|Free  Stream_  | 

|StatTc_Pressure  j 

Pressures 

1  in 

1 

1 

i 

| Measured  static  pressure 

| corrected  for  errors 

1 

1 

|<returned  value>| 

I  1 

1  1 

Distances 

1 

|  out 

1 

1 

| Altitude  in  feet  based 
j barometric  pressure  of 
j atmosphere 

on  the 
the 

3.3.5.1.9.1.10.1.4  LOCAL  DATA 


None. 


3.3.5.1.9.1.10.1.5  PROCESS  CONTROL 


Not  applicable. 


3.3.5.1.9.1.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

f unc t ion  Compu t e_Barome t r i c_Al t i  tude 

(Outside_Air_Temperature  :  Temperatures; 
Pree_Stream”Static_Pressure  :  Pressures) 
return  Distances  is- 

Pressure  Change  :  Pressures; 

Baro_AltItude  :  Distances; 

begin 

Pressure_Change  :■  Free  Stream_Static_Pressure  - 

PrevIous_Frie_S  t  ream_S  ta  t  i  c_Pressure ; 

if  (abs  Pressure_Change)  >  Maximum_Pressure_Change  then 

Previous  Free_Stream_Static_Pressure  :-  Free_Stream_Static_Pressure; 
Baro  Altitude  :-  Previous  Baro  Altitude; 
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else 

Baro_Alti tude  := 

Previous_Baro_Altitude  - 
(0.5  *  Gas_Constant)  * 

((  (Outside_Air_Temperature  /  Free_Stream_Static_Pressure)  + 
(Previous_Outside_Air_Temperature  / 

Previous_Free_S t ream_S  ta  t i c_Pressure ) 

)  *  Pressure_Change) ; 

Previous_Outside_Air_Temperature  :»  Outside_Air_Temperature; 
Previous_Free_Stream  Static_Pressure  Free_Stream_Static_Pressure; 
Previous_Baro_Altitu<Ie  s-  Baro_Altitude; 

end  if; 

return  Baro_Altitude; 
end  Compute_Barometric_Altitude; 


3.3.5.1.9.1.10.1.7  UTILIZATION  OF  OTBER  ELEMENTS 
None. 

3.3.5.1.9.1.10.1.8  LIMITATIONS 


None. 


3.3.5.1.10  UNIT  DESIGN 

3.3.5.1.10.1  COMPUTE  OUTSIDE  AIR  TEMPERATURE  (FUNCTION  BODY)  UNIT  DESIGN  (CATALOG 
#P317-0) 

This  i'nit  is  a  generic  function  which  computes  air  temperature  outside  of  a 
missile. 


3.3.5.1.10.1.1  REQUIREMENTS  ALLOCATION 
This  parts  meets  CAMP  Requirement  R228 


3.3.5.1.10.1.2  LOCAL  ENTITIES  DESIGN 
None. 


3.3.5.1.10.1.3  INPUT/OUTPUT 


GENERIC  PARAMETERS: 
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Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name  j  Type  |  Description 


Temperatures 


floating 
point  type 


Describes  air  temperatures 


Mach  Numbers 


floating  |  Describes  air  speed  as  a  ratio  of  the 
point  type  j  speed  of  sound 


Real 


floating 
point  type 


General  floating  point  type 


Data  objects: 

The  following  table  describes  the  generic  formal  objects  required  by  this  part: 


|  Name 

1  Type 

|  Value 

|  Description  | 

|Recovery_Factor  | 

|  Real 

1  N/A 

|  Constant  for  computing  Air  Tempi 

Subprograms: 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 


|  Name 

Type 

1 

Description 

1 

"*« 

function 

1 

Multiplies  a  Real  by  a  Mach  Number,  yielding 

1 

1 

1 

a  Mach  Number 

1 

1 

tl/f! 

function 

1 

1 

Divides  a  Temperature  by  a  Mach  Number, 

1 

1 

yielding  a  Temperature 

1 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 
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|  Name 
| 

1  Type  , 

Mode 

!  Description  | 

|Total_ 

{Temperature 

1 

{Temperatures  j 

; 

1  l 

in 

{Air  temperature  measured  by  the  j 
jair  data  instruments  ! 

;  i 

1 

j  Mach 

1 

| Mach  Numbers | 

1  i 

in 

(Missile  airspeed  as  a  fraction  1 
{of  the  speed  of  sound  j 

l  i 

| <returned  value> 
1 

(Temperatures | 

1  1 

out 

1  1 

(Temperature  of  the  air  outside  | 
jof  the  missile  j 

3.3.5.1.10.1.4  LOCAL  DATA 


None. 


3.3.5.1.10.1.5  PROCESS  CONTROL 
Not  applicable. 


3.3.5.1.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (AirDataParts) 

function  Compute_Outside_Air_Temperature 

(TotalTemperature  :  Temperatures; 

Mach  :  Mach_Numbers) 

return  Temperatures  is 


begin 

return  Total_Temperature  /  (1.0  +  0.2  *  Recovery_ Factor  *  Mach  *  Mach); 
end  Compu  t  e_0u  t  s  i  de_Ai  r_Tempe  r a  t u  r e ; 


3.3.5.1.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 


3.3.5.1.10.1.8  LIMITATIONS 


None. 


3.3.5.1.10.2  C0MPUTE_PRESSURE_RATI0  (FUNCTION  BODY)  UNIT  DESIGN  (CATALOG  #P318-0) 

This  unit  is  a  generic  function  which  computes  pressure  ratio  from  measured 
static  pressure,  measured  impact  pressure,  and  free  stream  static  pressure. 
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3.3.5.1.10.2.1  REQUIREMENTS  ALLOCATION 
This  parts  meets  CAMP  requirement  R229 


3.3.5.1.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.5.1.10.2.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name 

Type 

Description  | 

|  Pressures 

1 

floating 
point  type 

Describes  pressure  (i.e.  weight  per  | 

unit  of  area)  j 

|  Ratios 

1 

floating 
point  type 

A  unitless  floating  point  type  descri-| 
ing  ratio  of  one  pressure  to  another  | 

Subprograms : 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 


|  Name 

1  Type 

|  Description  | 

1 

| function 

1 

|  Divides  a  Pressure  by  a  Pressure,  yielding  a 
j  ratio 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 
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|  Name  |  Type 

|  Mode 

|  Description  | 

(Measured  Static  j Pressures 
| Pressure 

1  in 

1 

1 

(Static  pressure  measured  by  the  j 
(air  data  system  j 

l  l 

| Impact  Pressure  | Pressures 

1 

j  in 

1  l 

(Measured  difference  between  to tl | 
j pressure  and  static  pressure 

1  1 

|Free  Stream  (Pressures 

j Static  Pressure  j 

1  in 

1 

| 

(Measured  static  pressure  which  | 
jhas  been  corrected  for  errors 

!  1 

|<returned  value> | Ratios 

1  1 

1 

|  out 

1 

1  1 
| Unitless  quantity  computed  from  ( 
(static  and  impact  pressure  j 

3.3.5.1.10.2.4  LOCAL  DATA 


None. 


3.3.5.1.10.2.5  PROCESS  CONTROL 
Not  applicable. 


3.3.5.1.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (AirDataParts) 
function  Compute_Pressure_Ratio 

(Measured_Static_Pressure  :  Pressures; 
Impact_Pressure  :  Pressures; 

Free_Stream_Static_Pressure  :  Pressures) 
return  Ratios  i& 


begin 

return  (Measured_Static  Pressure  +  Irapact_Pressure)  / 
Pree_Stream_StatTc_Pressure ; 

end  Compute_Pressure_Ratio; 


3.3.5.1.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 


3.3.5.1.10.2.8  LIMITATIONS 


None. 
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3.3.5.1.10.3  C0MPUTE_MACH  (FUNCTION  BODY)  UNIT  DESIGN  (CATALOG  #P319-0) 

This  unit  is  a  generic  function  which  computes  missile  mach  given  pressure 
ratio. 


3.3.5.1.10.3.1  REQUIREMENTS  ALLOCATION 
This  parts  meets  CAMP  requirement  R230. 

3.3.5.1.10.3.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.5.1.10.3.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name 

1  Type 

Description  | 

|  Mach_Numbers  |  floating 
|  j  point  type 

i  i 

Describes  air  speed  as  a  ratio  of  the  | 
speed  of  sound 

1 

|  Ratios 

1 

i 

|  floating 
|  point  type 

1 

A  unitless  floating  point  type  descri-| 
ing  ratio  of  one  pressure  to  another  j 

Data  objects: 

The  following  table  describes  the  generic  formal  objects  required  by 

|  Name 

Type  | 

Value  |  Description  | 

|C0 

l 

Ratios  | 

1 

| First  curve  fit  parameter  | 

1  ; 

|C1 

1 

Ratios 

I 

1  I 

| Second  curve  fit  parameter 

1 

1 

|C2 

1 

Ratios  | 

1 

{Third  curve  fit  parameter  | 

Subprograms: 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 
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|  Name 

!  Type 

|  Description  | 

1  Sqrt 

1 

| function 

1 

|  Computes  the  square  root  of  Ratio,  yielding  a  | 
j  Mach  Number 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


Name  |  Type 

_ _  1 

1 

Mode 

Description 

1  _ _ 

1 

Pressure  Ratio  | Ratios 

in 

|Unitless  quantity  computed  from 

1 

j static  and  impact  pressures 

1 

<re turned  value>|Mach  Numbers 

1 

out 

1 

| Missile  airspeed  as  a  fraction 

j  of  the  speed  of  sound 


3.3.5.1.10.3.4  LOCAL  DATA 
None. 

3.3.5.1.10.3.5  PROCESS  CONTROL 
Not  applicable. 

3.3.5.1.10.3.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
separate  (Air_Data_Parts) 

function  Compute_Mach  (Pressure_Ratio  :  Ratios)  return  Mach_Numbers  is 
begin 

return  Sqrt  (CO  +  Pressure_Ratio  *  (Cl  +  C2  *  Pressure_Ratio)) ; 
end  Compute_Mach; 

3.3.5.1.10.3.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3.3.5.1.10.3.8  LIMITATIONS 


None. 
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3.3.5.1.10.4  COMPUTE_DYNAMIC_PRESSURE  (FUNCTION  BODY)  UNIT  DESIGN  (CATALOG 
#P320-0) 

This  unit  is  a  generic  function  which  computes  dynamic  pressure  from  missile 
mach  number  and  free  stream  static  pressure. 


3.3.5.1.10.4.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  Requirement  R231. 


3.3.5.1.10.4.2  LOCAL  ENTITIES  DESIGN 
None. 


3.3.5.1.10.4.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name  |  Type 

.  Description  | 

Pressures  |  floating 

Describes  pressure  (i.e.  weight  per 

j  point  type 

' 

unit  of  area) 

1 

Mach  Numbers  |  floating 

Describes  air  speed  as  a  ratio  of  the 

j  point  type 

speed  of  sound 

Subprograms: 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 


|  Name 

1  Type 

|  Description  | 

|  *»*" 

1 

|  function 

1 

|  Multiplies  a  Pressure  by  a  Mach  Number,  | 

j  yielding  a  Pressure 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 
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|  Name 

1 

1  Type 

Mode  | 

1 

I  Free  Stream 

j  Pressures 

in 

|Static_Pressure 

1 

1 

1 

|Mach 

1 

1 

|Mach  Numbers 

in 

|<re turned  value> 

1 

| Pressures 

out  j 

Description 


Measured  static  pressure  which 
has  been  corrected  for  errors 

Missile  airspeed  as  a  fraction 
of  the  speed  of  sound 

Missile  dynamic  pressure 


3.3.5.1.10.4.4  LOCAL  DATA 


None. 


3.3.5.1.10.4.5  PROCESS  CONTROL 


Not  applicable. 


3.3.5.1.10.4.6  PROCESSING 

The  folloving  describes  the  processing  performed  by  this  part: 

separate  (AirDataParts) 

function  Compute_Dynamic_Pressure 

(Pree_Stream_Static_Pressure  :  Pressures; 

Mach  ~  :  Mach_Numbers) 

return  Pressures  is 


begin 

return  0.7  *  FreeJStream_Static_Pressure  *  (Mach  *  Mach); 
end  Compute_Dynamic_Pressure; 


3.3.5.1.10.4.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 


3.3.5.1.10.4.8  LIMITATIONS 


None. 


3.3.5.1.10.5  COMPUTE_SPEED_OF_SOUND  (FUNCTION  BODY)  UNIT  DESIGN  (CATALOG  #P321-0) 

This  unit  is  a  generic  function  which  computes  the  speed  of  sound  given  the 
temperature  of  the  air. 
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REQUIREMENTS  ALLOCATION 


This  part  meets  CAMP  requirement  R232. 


3.3.5.1.10.5.2  LOCAL  ENTITIES  DESIGN 
None. 


3.3.5.1.10.5.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name 

Type 

1 

Description 

1 

Temperatures 

floating 

1 

Describes  air  temperatures 

point  type 

1 

l 

Velocities 

floating 

1 

Describes  air  speed 

point  type 

1 

Data  objects: 

The  following  table  describes  the  generic  formal  objects  required  by  this  part: 


|  Name 

1  Type 

|  Value 

|  Description  | 

| Speed_Of_ 
j  Sound_ 
jCons tant 

(Velocities 

1 

|  N/A 

1 

| Standard  speed  of  sound  at 
jsea  level 

1 

Subprograms : 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 


|  Name  |  Type 

|  Description 

1 

| | function 

1  1 

l  i 

|  Multiplies  a  Velocity  by  a  Temperature, 
j  yielding  a  Velocity 

1 

1 

1 

1 

1  1 

|Sqrt  | function 

1  1 

1 

|  Computes  the  square  root  of  a  Temperature, 
j  yielding  a  Temperature 

1 

1 

1 

# 
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FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name  |  Type  | 

1  1  1 

Mode 

|  Description 

1  _  ...  .  _  _ 

1 

_  | 

1  1  1 
|Air  Temperature  | Temperatures  | 

1  “  1  1 

in 

1 

|Temperature  of  the  air 

1 

■  1 

1 

1  1  1 

|<returned  value> (Velocities  | 

out 

1 

| Speed  of  sound  in  air 

1 

1 

3.3.5.1.10.5.4  LOCAL  DATA 
None. 

3.3.5.1.10.5.5  PROCESS  CONTROL 
Not  applicable. 

3.3.5.1.10.5.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
separate  (Air_Data_Parts) 

function  Coupute_Speed_of_Sound  (Air_Temperature  :  Temperatures) 

return  Velocities  is 

begin 

return  Speed_Of_Sound_Constant  *  Sqrt  (Air_Temperature); 
end  Compute_Speed_of_Sound; 

3.3.5.1.10.5.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3.3.5.1.10.5.8  LIMITATIONS 


None. 
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package  body  Air_Data_Parts  is 

function  Compute_Outside_Air_Temperature 

(Total_Temperature  :  Temperatures; 

Mach  :  Mach_Numbers) 

return  Temperatures  is  separate; 

function  Compute_Pressure_Ratio 

(Measured_StaIic_Pressure  :  Pressures; 

Impact_Pressure  :  Pressures; 

Free_Stream_Static_Pressure  :  Pressures) 
return  Ratios  is  separate; 

function  Compute_Mach 

(Pressure_Ratio  :  Ratios) 
return  Mach_Numbers  is  separate; 

function  Compute_Dynamic_Pressure 

(Free_Stream_Static_Pressure  :  Pressures; 

Mach  :  Mach_Numbers) 

return  Pressures  is  separate; 

function  Compute_Speed_Of_Sound 

(Air_Temperature  :  Temperatures) 
return  Velocities  is  separate; 

package  body  Barometric_Altitude_Integration  is  separate 
end  Air  Data  Parts; 
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separate  (Air_Data_Parts) 

function  Compute_Outside  Air  Temperature 

(Total_Temperature  :  Temperatures; 
Mach  :  Mach_Numbers) 

return  Temperatures  is 


begin 

return  Total_Temperature  /  (1.0  +  0.2  *  Recovery_Factor  *  Mach  *  Mach); 
end  Compu t e_0u t s i de_Ai r_Tempera ture ; 
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separate  (Air_Data_Parts) 
function  Compute_Pressure_Ratio 

(Measured_Static_Pressure  :  Pressures; 
Impact_Pressure~  :  Pressures; 

Free_Stream_Static_Pressure  :  Pressures) 
return  Ratios  is 


begin 

return  (Measured_Static  Pressure  +  Impact_Pressure)  / 
Free_S  t  ream_S  tatTc_Pressure ; 

end  Compute_Pressure_Ratio; 
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separate  (Air_Data_Parts) 

function  Compute_Mach  (Pressure_Ratio  :  Ratios)  return  Mach_Numbers  is 
begin 

return  Sqrt  (CO  +  Pressure_Ratio  *  (Cl  +  C2  *  Pressure_Ratio)); 
end  Compute_Mach; 


CAMP  Software  Detailed  Design  Document 


Page  597 


separate  (Air_Data_Parts) 

function  Compute_Dynamic_Pressure 

(Free_Stream~Static_Pressure  :  Pressures; 
Mach  :  Mach_Numbers) 

return  Pressures  is 


begin 

return  0.7  *  Free  Stream  Static  Pressure  *  (Mach  *  Mach); 


end  Compute_Dynamic_Pressure; 
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separate  (Air_Data_Par ts) 

function  Compute_Speed_Of_Sound  (Air_Temperature  :  Temperatures) 

return  Velocities  is 

begin 

return  Speed_Cf_Sound_Constant  *  Sqrt  (Air_Temperature) ; 
end  Compute_Speed_Of_Sound; 
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separate  (Air_Data_Parts) 

package  body  Barometric_Altitude_Integration  is 


PreviousFree  Stream_Static_Pressure  :  Pressures 
Previous_OutsIde_Air  Temperature  :  Temperatures 
Previous  Baro  Altitude  :  Distances  :* 


Initial  Free_Stream_Pressure 
InitIal_Temperature; 

In i t i al_Bar o_Al t i t  ude ; 

pragma  PAGE ; 


function  Compute_Barometric_Alti tude 

(Outside_AiL_Temperature  :  Temperatures; 
Free_Stream_Static_Pressure  :  Pressures) 
return  Distances  is 


Pressure  Change  :  Pressures; 

Baro_AltItude  :  Distances; 

begin 

Pressure_Change  :■  Free  Stream  Static_Pressure  - 

PrevIous_Fr  ee_S  t  r  eam_S  t  a  t  i  c_Pressure ; 

if  (abs  Pressure_Change)  >  Maximum_Pressure_Change  then 

Previous  FreeStreamStatlcJPressure  :»  Free_Stream_Static_Pressure; 
Baro_AltTtude  Previous_Baro_Altitude; 

else 

BaroAltitude  :■ 

Previous_Baro_Altitude  - 
(0.5  *  GasConstant)  * 

((  (Outside_Air_Temperature  /  Free_Stream_Static_Pressure)  + 
(Previous_Outside_Air_Temperature  / 
Previous_Free_Stream~Static_Pressure) 

)  *  Pressure_Change) ; 

Previous_Outside_Air_Temperature  :■  Outside_Air_Temperature; 
Previous_Free_Stream  Static_Pressure  s»  Free_Stream_Static_Pressure; 
Previous  Baro  AltituSe  i-  Baro_Altitude; 

end  if; 

return  Baro_Altitude; 
end  Compu te_Barome  t  r  i  c_Al  t  i  t ude ; 
end  Bar ome  t r i  c  _A1  tit  ude_In  t  egr a  t  i  on ; 


CAMP  Software  Detailed  Design  Document 


Page  600 


(This  page  left  intentionally  blank.) 
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3. 3. 5. 2  FUEL_C0NTR0L_PARTS  TLCSC  P672  (CATALOG  #P1096-0) 

This  TLCSC  contains  parts  which  can  be  used  to  manage  missile  fuel  consumption. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 5. 2.1  REQUIREMENTS  ALLOCATION 

The  following  chart  summarizes  the  allocation  of  CAMP  requirements  to  this 
part: 


|  Name 

|  Requirements  Allocation  | 

|  Thro 1 1 le_Command_Manager 

|  R234  | 

3. 3. 5. 2. 2  LOCAL  ENTITIES  DESIGN 
None. 

3. 3. 5. 2. 3  INPUT/OUTPUT 
None. 

3. 3. 5. 2. 4  LOCAL  DATA 
None. 

3. 3. 5. 2. 5  PROCESS  CONTROL 
Not  applicable. 


3. 3. 5. 2. 6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

with  Signal  Processing; 
with  Autopilot; 

package  body  Fuel_Control_Parts  is 
end  Fuel_Con  t  rol_Par  t  s ; 

3. 3. 5. 2. 7  UTILIZATION  OF  OTHER  ELEMENTS 

The  following  library  units  are  with'd  by  this  part: 

1.  Signal  Processing 

2.  Autopilot 
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3. 3. 5. 2. 8  LIMITATIONS 


None. 


3. 3. 5. 2. 9  LLCSC  DESIGN 

3. 3. 5. 2. 9.1  THROTTLE_COMMAND_MANAGER  PACKAGE  DESIGN 

This  LLCSC  is  a  generic  package  which  manages  the  throttle  command. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 5. 2. 9. 1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  Requirement  R234. 


3. 3. 5. 2. 9. 1.2  LOCAL  ENTITIES  DESIGN 


Packages : 

The  packages  Integral  PlusProportionalGain,  Tustin_Integrator_Vith_Limit, 
Tustin_Integrator_VitK_Asymmetric_Limit,  and  AbsoluteLimiter  are  instantiated 
inside  the  package  body. 

Subprograms : 

This  package  contains  a  sequence  of  statements  which  are  executed  when  this 
part  is  elaborated.  This  code  initializes  the  state  of  the  throttle  command 
manager . 


3. 3. 5. 2. 9. 1.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name 

Type 

Description  | 

|Mach  Numbers 

floating 

Represents  missile  speed  as  a  ratio  of 

1 

1 

point  type 

the  speed  of  sound 

1 

1  Mach  Number 

floating 

Represents  a  gain  which  converts  from 

j Gains 

point  type 

Mach  Number  to  Throttle  Command 

1 

| Throttle 

floating 

Represents  a  command  to  open/close 

| Commands 

point  type 

the  throttle 
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Data  objects: 

The  following  table  describes  the  generic  formal  objects  required  by  this  part: 


|  Name 

Type 

Mode|  Description 

Initial  Mach_ 
Command 

Mach_ 

Numbers 

in 

Mach  Number  of  missile  at 
startup 

Initial  Mach 
Feedback 

Mach_ 

Numbers 

in 

Mach  Feedback  from  missile 
at  startup 

Initial  Mach 

Error  Limit 

Mach_ 

Numbers 

in 

Limit  of  Mach  Error 

Initial  Mach 

Error  Gain 

Mach 

Number_Gain 

in 

Gain  to  convert  from  mach 
error  to  raw  throttle  command 

Initial  Mach 

Error  Integral 
Limit 

Throttle_ 

Commands 

in 

Limit  for  Mach  Error  Integral 
at  startup 

Initial_Throttle_ 

Command 

Throttle_ 

Commands 

in 

Throttle  Command  at  startup 

InitialThrottle 
Command_Ra  t  e_Li  ml  t 

Throttle_ 

Commands 

in 

Limit  on  Throttle  Command  Rate 
at  startup 

Initial_Lover_ 

Thro  1 1 le_Command_ 
Limit 

Throttle_ 

Commands 

in 

Lover  Limit  of  Throttle 

Command 

Initial_Upper_ 

Thro  1 1 le_Command_ 
Limit 

Throttle_ 

Commands 

in 

Upper  Limit  of  Throttle 

Command 

Ini t ial_Throt  tle_ 
Bandvidth 

Throttle_ 

Commands- 

i 

in  | 3  db  bandvidth  of  the  throttle 
| command 

Subprograms : 

The  following  table  deso  -s  the  generic  formal  subroutines  required  by  this 
part: 


|  Name 

1  Type 

|  Description 

1 

|  "*« 

1 

function 

|  Multiplies  a  Mach  Number  by  a 
|  yielding  a  ThrottIe_Command 

Mach  Number  Gain| 
‘  1 
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3. 3. 5. 2. 9. 1.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


Name 


I  Type  | 


Description 


|Mach  Error 

Mach_  {Difference  between  Measured  Mach  and  | 

l 

Numbers  j requested  Mach  1 

1 

| Thro  1 1 le_Command_ 

1  1 
Throttle_|Rate  at  which  the  throttle  is  being 

|Rate 

i 

Commands  | opened  or  closed  j 

I  i 

1 

| Stored  Throttle_ 

1  1 

Throttle_| Previous  Throttle  Command  [ 

j Command 

i 

Commands  |  { 

i  i 

1 

|Raw  Throttle 

1  1 
Throttle  {Computed  Throttle  Command 

j  Command 

I 

Commands  {(not  limited)  j 

l  i 

| Initial  IPP_ 

1  ! 

Throttle  |The  initial  state  computed  and  sent  | 

j Integral 

Commands  j  to  the  Integral  Plus  Proporational 

1 

j Gain  package  j 

3. 3. 5. 2. 9. 1.5  PROCESS  CONTROL 


Not  applicable. 


3. 3. 5. 2. 9. 1.6  PROCESSING 


The  following  describes  the  processing  performed  by  this  part: 


package  body  Throttle_Command_Manager  is 


MachError 

Throttle  Command_Rate 
Stored_TKrot  tle_Command 
Raw_Throttle  Command 
Initial_IPP_Tntegral 


:  Mach_Numbers ; 

:  Throttle_€ommands; 
:  Throttle_Commands; 
:  Throttle_Commands; 
:  Throttle  Commands; 


package  Mach_Error_Limiter  is  new  Signal_Processing. 

Absolute_Limi ter 
(Signal  Type  ■>  Mach~Numbers , 

Initial  Absolute  Limit  »>  Initial  Mach  Error  Limit); 


package  Throttle_Command_Rate_Limiter  is  new  Signal_Processing. 

Absolute_Limiter 

(Signal  Type  ->  Throttle_Commands, 

Initial  Absolute  Limit  ■>  Initial  Throttle  Command  Rate  Limit); 
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package  IPPJTustin  is  new 

(Signals 

States 

Gained_Signals 

Gains 

Ini tial_Tustin_Gain 

Initial_Signal_Level 

Initial_State 

Ini tial~Signal_Limi t 


Signal_Processing. 

Tus  t in_In tegrator_Wi th_Limi t 
=>  Mach_Numbers , 

=>  Throttle_Commands, 

=>  Throttle  Commands, 

=>  Mach  NumEer  Gains, 

=>  Ini t!al_MacE_Error_Gain, 

=>  Ini tial~Mach_Command, 

->  Initial_Throttle_Command, 

»>  Initial_Mach_Error_Integral_Limit) ; 


package  IPP  Gain  is  new  Autopilot. Integral_Plus_Proportional_Gain 
Tlnput  Signals  *>  Mach_Numbers , 

Gains  ->  Mach_Number_Gains , 

Integrated_Signals  ->  Throttle_Commands, 

Initial_Proportional_Gain  =>  Initial_Mach_Error_Gain, 

Tustin_Integrate  ->  IPP_Tustin. Integrate) ; 


package  Tustin  is  new  Signal_Processing. 

Tustin_Integrator  With  Asymmetric_Limit 
(Signals  ■>  TErottIe_Commands, 

States  ->  Throttle_Commands, 

GainedSignals  »>  ThrottleCommands, 

Gains  ->  Throttle  Commands, 

InitialTustinGain  »>  InitialThrottleBandvidth, 

Initial_Signal_Level  ■>  InitialThrottleCommand, 

InitialState  »>  InitialThrottleCommand, 

Initial_Signal_Lower_Limit  ■> 

Initial  Lower_Throttle_Command_Limit, 
Initial_Signal_Upper_LimTt  -> 

IniIial_Upper_Thro  1 1  le_Command_Limi  t ) ; 


—  — begin  processing  for  Throttle 

—  — Command_Manager  package  body 


begin 

Mach_Error  :=  0.0; 

Mach_Error:-  Mach_Error_Limi ter. Limit  (Mach_Error) ; 

Raw_Throttle_Command  :=  Inif.lal_Throttle_Command; 
Stored_Throttle_Command  :■  0.0; 

Initial_IPP_Integral  :«•  Raw  Throttle_Command  - 

MacE_Error  *  Initial_Mach_Error_Gain; 

IPPJTustin. Reset  (Integrator_State  ■>  Initial_IPP_Integral, 
Signal  ->  Mach_Error); 

end  Throttle  Command  Manager; 
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3. 3. 5. 2. 9. 1.7  UTILIZATION  OF  OTHER  ELEMENTS 

The  following  library  units  are  with'd  by  this  part's  TLCSC: 

1.  Signal  Processing 

2.  Autopilot 

UTILIZATION  OF  EXTERNAL  ELEMENTS: 

Packages : 

The  following  table  summarizes  the  external  packages  required  by  this  part: 


|  Name 

Type 

Source 

Description  | 

| Absolute  Limiter 

generic 

package 

(1) 

Limits  a  value  by  an  absolute 
value 

1 

|Tustin  Integrator 
j_Wit’i_Limit 

1 

generic 

package 

(1) 

Performs  a  Tustin  integration 
of  an  independent  variable  and 
performs  an  absolute  limit  of 
the  result 

| Tus  t in_In  tegra tor 
j  Vi thAsymme  t  r i c_ 

J 

1 

generic 

package 

(1) 

Performs  a  Tustin  integration 
of  an  independent  variable  and 
performs  an  upper/lower  limit 
of  the  result 

|Integral_Plus 
j  Proport ional_5ain 

generic 

package 

(2) 

Performs  an  integral  plus 
proportional  gain  computation 
of  a  subject  variable 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  pare  it  top  level  component: 


|  Name 

Type 

|  Source 

|  Description  | 

| Limit 

I 

function 

| Mach_Error_ 

| Limiter 

| Limits  the  Mach  Error 

; 

i 

1 

(Reset 

procedure 

| IPP  Tustin 

i 

(Initializes  the  Tustin 

i 

i 

1  " 

1 

(Integrator  used  by  the 
(IPP  Gain 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined 
elsewhere  in  the  LLCSC  Package  Specification: 


CAMP  Software  Detailed  Design  Document 


Page  607 


|  Name 


Type 


Description 


Mach  Numbers 


floating  | Represents  missile  speed  as  a  ratio  of 

point  type  j the  speed  of  sound 


Mach_Number 

Gains 


floating  (Represents  a  gain  which  converts  from 
point  type  |Mach  Number  to  Throttle  Command 


Throttle 

Commands 


floating  (Represents  a  command  to  open/close 
point  type  j the  throttle 


Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  LLCSC  package  body: 


|  Name 

Type 

Description  | 

|Mach  Error 

Mach 

Difference  between  Measured  Mach  and 

1 

1 

Numbers 

requested  Mach 

1 

| Stored  Throttle_ 
j Command 

i 

Throttle_ 

Commands 

Previous  Throttle  Command 

i 

I  Raw  Throttle 

Throttle 

Computed  Throttle  Command 

j  Command 

Commands 

(not  limited) 

3. 3. 5. 2. 9. 1.8  LIMITATIONS 


None. 


3. 3. 5. 2. 9. 1.9  LLCSC  DESIGN 
None. 


3.3.5.2.9.1.10  UNIT  DESIGN 

3.3.5.2.9.1.10.1  COMPUTE JTHROTTLE_COMMAND  UNIT  DESIGN 

This  unit  is  a  function  which  computes  the  nev  throttle  command. 


3.3.5.2.9.1.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R234. 
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3.3.5.2.9.1.10.1.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.5.2.9.1.10.1.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name  | 

Type 

|  Mode 

1 

Description 

|  Mach  Command  i 

Mach 

1  i° 

1 

Vanted  Missile  mach 

1  1 

Numbers 

1 

1 

|  Mach  Feedback  [ 

Mach 

1  in 

1 

1 

Measured  Missile  mach 

Numbers 

1 

1 

1 

|<returned  value> | 

Throttle_ 

Commands 

1  in 

1 

Computed  Throttle  Command 

3.3.5.2.9.1.10.1.4  LOCAL  DATA 


None. 


3.3.5.2.9.1.10.1.5  PROCESS  CONTROL 


Not  applicable. 


3.3.5.2.9.1.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  Compute  Throttle_Command 

(MacK_Command  :  in  Mach_Numbers; 

Mach_Feedback  :  in  Mach_Numbers) 

return  Throttle_Commands  is 

begin 

Mach_Error  :-  Mach_Command  -  Mach_Feedback; 

Mach_Error:-  Mach_Error_Limi ter. Limit  (Mach_Error); 

Raw_Throttle_Command  :-  IPP_Gain. Integrate  (Signal  ->  Mach_Error); 

Throttle_Command_Rate  :-  Raw_Throttle_Command  - 

Stored_Throttle_Command; 

Throttle_Command_Rate  :-  Throttle_Command  Rate_Limi ter. Limit 

(Throttle_Comman3_Rate) ; 


THIS  REPORT  HA*  MEN  DELIMITED 
AND  CLEARED  FOR  PUBLIC  RELIME 

i 

UNDER  DOC  DIRECTIVE  5200.20  AND 

! 

NO  RESTRICTIONS  ARC  IMPOSED  UPON 
.TS  USE  AND  DISCLOSURE. 

I 

DISTRIBUTION  STATEMENT  A 

« 

APPROVED  POR  PUBLIC  RELEASE j 

I 

DISTRIBUTION  UNLIMITED i 
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Stored_Throttle_Command  Tustin. Integrate 

(Signal  =>  Throttle_Command_Rate) ; 

return  Stored_Throttle_Command; 

end  Compute_Throttle_Command; 


3.3.5.2.9.1.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name 

Type 

|  Source 

Description  | 

|  Limit 

1 

1 

function 

| Mach_Error 
| Limi ter 

Limits  the  Mach  Error  | 

1 

| 

1 

j  Limit 

1 

i 

function 

j Throttle 
|Command_Rate 
j Limi ter” 

1 

Limits  the  Throttle  Command | 
Rate  j 

1 

(Integrate 

1 

function 

| IPP_Gain 

Computes  the  Raw  Throttle  | 
Command  j 

1 

(Integrate 

1 

function 

(Tustin_ 

(Integrator 

Computes  the  Final  Throttle | 
Command  j 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined 
elsewhere  in  the  LLCSC  Package  Specification: 


|  Name 

1  Type 

|  Description  | 

Mach  Numbers 

| floating 

(Represents  missile  speed  as  a  ratio  of 

j  point  type 

1 

j  the  speed  of  sound 

I 

Throttle 

| floating 

1 

(Represents  a  command  to  open/close 

Commands 

j  point  type 

(the  throttle 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  LLCSC  package  body: 
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|  Name 

1  Type 

|  Description 

1 

|Mach  Error 

|Mach 

(Difference  between  Measured  Mach  and 

1 

l 

j Numbers 

{requested  Mach 

l 

1 

1 

1 

| Throttle  Command 

|Throttle 

|Rate  at  which  the  throttle  is  being 

1 

(Rate 

i 

j Commands 

j opened  or  closed 

1 

1 

(Stored  Throttle 

|Throttle 

(Previous  Throttle  Command 

1 

I 

j  Command 

I 

j Commands- 

1 

1 

1 

IRaw  Throttle 

1 

(Throttle 

1 

(Computed  Throttle  Command 

1 

1 

| Command 

j Commands 

j(not  limited) 

1 

3.3.5.2.9.1.10.1.8  LIMITATIONS 
None. 

3.3.5.2.9.1.10.2  UPDATE_MACH_ERROK_LIMIT  UNIT  DESIGN 
This  unit  is  a  procedure  which  updates  the  mach  error  limit. 

3.3.5.2.9.1.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R234. 

3.3.5.2.9.1.10.2.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.5.2.9.1.10.2.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

!  Type 

|  Mode 

Description  | 

|Nev  Limit 

1  " 

|  Mach_ 

|  Numbers 

1  in 

1 

New  Mach  Error  limit  | 

1 

3.3.5.2.9.1.10.2.4  LOCAL  DATA 


None. 
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3.3.5.2.9.1.10.2.5  PROCESS  CONTROL 


Not  applicable. 


3.3.5.2.9.1.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Mach_Error_Limit  (Nev_Limit  :  in  Mach_Numbers)  is 
begin 

Mach_Error_Limiter.Update_Limit  (Nev_Absolute_Limit  »>  New_Limit); 
end  Update  Mach  Error  Limit;- 


3.3.5.2.9.1.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsevhere  in  the  parent  top  level  component: 


|  Name 

Type 

|  Source  |  Description  | 

| Update  Limit 

1 

function 

|Mach_Error_  | Updates  the  mach  error  j 

j Limiter  | limit 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined 
elsewhere  in  the  LLCSC  Package  Specification: 


|  Name 

1  Type 

|  Description  | 

|Mach  Numbers 

1 

|  floating 
j  point  type 

| Represents  missile  speed  as  a  ratio  of  | 
j the  speed  of  sound  j 

3.3.5.2.9.1.10.2.8  LIMITATIONS 


None. 


3.3.5.2.9.1.10.3  UPDATE_MACH_ERROR_INTEGRAL_LIMIT  UNIT  DESIGN 
This  unit  is  a  procedure  which  updates  the  mach  error  integral  limit. 
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3.3.5.2.9.1.10.3.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R234. 

3.3.5.2.9.1.10.3.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.5.2.9.1.10.3.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode 

|  Description  | 

|New  Limit 

|  Mach 

1  in 

|  New  Mach  Error  integral  limit  | 

1  1 

1 

|  Numbers 

1 

3.3.5.2.9.1.10.3.4  LOCAL  DATA 


None. 


3.3.5.2.9.1.10.3.5  PROCESS  CONTROL 


Not  applicable. 


3.3.5.2.9.1.10.3.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Mach_Error_Integral  Limit 

(New_Llmit  :  in  Throttle_Commands)  is 

begin 

IPP  Tustin.Update_Limit  (New  Absolute_Limit  ->  Nev_Limit); 
end  UpJa  t  e_Mach_E  r  r o  r_In  t  egral_Ei  mi  t ; 


3.3.5.2.9.1.10.3.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 
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|  Name 

Type 

|  Source 

|  Description  | 

| Update  Limit 

function 

jMach  Error 

| Updates  the  mach  error  | 

I  Integral 

j integral  limit 

I 

j  Limiter 

1  1 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined 
elsewhere  in  the  LLCSC  Package  Specification: 


|  Name 

1  Type 

|  Description  | 

|Mach  Numbers 

1  " 

| floating 
j  point  type 

| Represents  missile  speed  as  a  ratio  of  | 
j the  speed  of  sound 

3.3.5.2.9.1.10.3.8  LIMITATIONS 
None. 

3.3.5.2.9.1.10.4  UPDATETHROTTLERATELIMIT  UNIT  DESIGN 
This  unit  is  a  procedure  which  updates  the  throttle  rate  limit. 

3.3.5.2.9.1.10.4.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R234. 

3.3.5.2.9.1.10.4.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.5.2.9.1.10.4.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

Mode  | 

Description  | 

|New  Limit 

|  Throttle 

in  | 

New  Throttle  Rate  limit  1 

1 

j  Commands 

1 

1 
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3.3.5.2.9.1.10.4.4  LOCAL  DATA 


None. 


3.3.5.2.9.1.10.4.5  PROCESS  CONTROL 


Not  applicable. 


3.3.5.2.9.1.10.4.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Throttle_Rate_Limit(Nev_Limit  :  in  Throttle_Commands)  is 
begin 

Throttle_Command_Rate_Limiter.Update_Limit 

(New_Absolute_Limit  *>  New_Limit); 

end  Update_Throttle_Rate_Limit; 


3.3.5.2.9.1.10.4.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name 

Type 

|  Source  |  Description  | 

| Update  Limit 

1 

I 

function 

|Throttle_  | Updates  the  Throttle 
jCommandjRatej  Command  Rate  limit 
| Limiter-  j 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined 
elsewhere  in  the  LLCSC  Package  Specification: 


|  Name 

1  Type 

|  Description  | 

|Throttle_ 
j  Commands” 

| floating 
j  point  type 

(Represents  a  command  to  open/close 
j the  throttle 
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3.3.5.2.9.1.10.4.8  LIMITATIONS 


None. 


3.3.5.2.9.1.10.5  UPDATE JTHROTTLE_COMMAND_LIMITS  UNIT  DESIGN 
This  unit  is  a  procedure  which  updates  the  throttle  command  limits. 


3.3.5.2.9.1.10.5.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R234. 


3.3.5.2.9.1.10.5.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.5.2.9.1.10.5.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1 

Type 

|  Mode 

1 

Description  | 

|Nev  Lover  Limit 

1 

Throttle 

1  in 

1 

New  Lover  Throttle  Command 

1 

1 

Commands 

Limit 

1 

I  New  Upper  Limit 

1 

Throttle 

1  in 

1 

1 

New  Upper  Throttle  Command 

1 

1 

Commands 

I 

Limit 

3.3.5.2.9.1.10.5.4  LOCAL  DATA 


None. 


3.3.5.2.9.1.10.5.5  PROCESS  CONTROL 


Not  applicable. 


3.3.5.2.9.1.10.5.6  PROCESSING- 

The  following  describes  the  processing  performed  by  this  part: 

procedure  Update_Throt  t  le_Command_Limi  ts 

(New_Lower_Limit  :  in  Throttle_Commands; 
Nev_Upper~Limit  :  in  Throttle_Commands)  is 

begin 

Tustin.Update_Limits  (New_Lower_Limit  ■>  Nev_Lower_Limi t , 

Nev~Upper_Limit  ->  New_Upper_Limi  t ) ; 
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end  Update_Throt t le_Command_Limi ts ; 


3.3.5.2.9.1.10.5.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsevhere  in  the  parent  top  level  component: 


|  Name 

Type 

|  Source 

|  Description  | 

| Update  Limit 

1 

function 

|Tustin 

1 

| Updates  the  Throttle  | 

Command  limits  j 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined 
elsevhere  in  the  LLCSC  Package  Specification: 


|  Name 

1  Type 

|  Description  | 

|Throttle_ 
j  Commands 

|  floating 
j  point  type 

(Represents  a  command  to  open/close 
(the  throttle 

3.3.5.2.9.1.10.5.8  LIMITATIONS 


None. 


3.3.5.2.9.1.10.6  UPDATE_MACH_ERROR_GAIN  UNIT  DESIGN 
This  unit  is  a  procedure  which  updates  the  mach  error  gain 


3.3.5.2.9.1.10.6.1  REQUIREMENTS  ALLOCATION 

( 

This  part  meets  CAMP  requirement  R234. 


3.3.5.2.9.1.10.6.2  LOCAL  ENTITIES  DESIGN 


None. 
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3.3.5.2.9.1.10.6.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 


The  following  table  describes 

this 

part's  formal  parameters: 

|  Name 

1  Type 

Mode 

|  Description  | 

|New  Gain 

1 

|  Mach_ 
j  Numbers 

in 

|  New  Mach  Error  Gain  | 

1  1 

3.3.5.2.9.1.10.6.4  LOCAL  DATA 
None. 

3.3.5.2.9.1.10.6.5  PROCESS  CONTROL 
Not  applicable. 

3.3.5.2.9.1.10.6.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

procedure  UpdateMachErrorGain  (Nev_Gain  :  in  Mach_Number_Gains)  is 
begin 

IPP  Tustin.Update_Gain  (NevGain  ->  NewGain); 
end  Up3ate_Mach_Error_Gain; 


3.3.5.2.9.1.10.6.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsewhere  in  the  parent  top  level  component: 


|  Name 

1  Type 

|  Source 

|  Description  | 

| Update_Gain 

|  procedure 

|IPP_Tustin 

(Updates  the  Mach  Error  Gain| 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined 
elsewhere  in  the  LLCSC  Package  Specification: 
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|  Name 

1  Type 

|  Description  | 

|Mach  Numbers 

1 

| floating 
j  point  type 

| Represents  missile  speed  as  a  ratio  of  [ 

| the  speed  of  sound  | 

3.3.5.2.9.1.10.6.8  LIMITATIONS 
None. 

3.3.5.2.9.1.10.7  UPDATE_THROTTLE_BANDVIDTH  UNIT  DESIGN 

This  unit  is  a  procedure  vhich  updates  the  3  db  throttle  command  bandwidth 

3.3.5.2.9.1.10.7.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R234. 

3.3.5.2.9.1.10.7.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.5.2.9.1.10.7.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

Mode 

Description  | 

1  New  Bandwidth 

1  Throttle 

in 

New  Throttle  Bandwidth  | 

j  j  Commands 

1 

3.3.5.2.9.1.10.7.4  LOCAL  DATA 
None. 

3.3.5.2.9.1.10.7.5  PROCESS  CONTROL 
Not  applicable. 

3.3.5.2.9.1.10.7.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
procedure  Upda te_Thro 1 1 le_Bandwid  th 
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(Nev_Bandwidth  :  in  Throttle  Commands)  is 

begin 

Tustin.Update_Gain  (New  Gain  =>  New_Bandwidth) ; 
end  Update  Throttle_Bandwicfth; 


3.3.5.2.9.1.10.7.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  elsevhere  in  the  parent  top  level  component: 


|  Name 

|  Type  |  Source 

1  Description  j 

| Update  Gain 

1 

|  procedure  jTustin 

1  1 

|Updates  the  Gain  (i.e.,  | 

j throttle  command  bandwidth)! 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined 
elsevhere  in  the  LLCSC  Package  Specification: 


|  Name 

1  Type 

|  Description  | 

|Throttle_ 
j  Commands 

| floating 
j  point  type 

| Represents  a  command  to  open/close  | 

j the  throttle  j 

3.3.5.2.9.1.10.7.8  LIMITATIONS 


None. 

3.3.5.2.10  UNIT  DESIGN 


None. 
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with  Signal  Processing; 
vith  Autopilot; 

package  body  Fuel_Control_Parts  is 


package  body  Throttle_Command_Manager  is 


Mach_Error 

Throttle  Command_Rate 
S tored_TKro t t le_Command 
Rav_Thro  1 1 le_Command 
I  n  i  t  i  al_I  pp_f n  t  egr  a  1 


:  Mach_Numbers ; 

:  Throttle_Commands; 
:  Throttle  Commands; 
:  Throt  tle  Commands ; 
:  Throttle  Commands; 


pragma  PAGE; 


package  Mach_Error_Limiter  is  nev  Signal_Processing. 

Absolute_Limiter 
(Signal  Type  »>  Mach  Numbers, 

InitiaI_Absolute_Limit  ■>  InitTal_Mach_Error_Limit) ; 


package  Throttle_Comaand_Rate_Limiter  is  nev  Signalprocessing. 

Absolute_Limiter 

(Signal  Type  ->  Throttle  Commands, 

InitialAbsoluteLimit  ->  Initial_Throttle_Command_Rate_Limit) ; 


package  Ipp_Tustin  is  nev 

(Signals 

States 

Gained_Signals 

Gains 

Initial_Tustin_Gain 
Ini tial_Signal_Level 
Initial_State 
Ini tial_Signal_Limit 


Signal_Processing. 

Tustin_Integrator_With_Limit 
■>  Mach_Numbers , 

->  Throttle_Comaands, 

»>  Throttle  Commands, 

->  Mach  NumEer  Gains, 

«>  InitTal_MacE_Error_Gain, 

->  Ini t ial~Mach_Command , 

->  Initial_Throttle_Command, 

■>  Initial~Mach_Error_Integral_Limit) ; 


package  Ipp  Gain  is  nev  Autopilot. Integral_Plus_Proportional_Gain 
Tlnput_Signals  ■>  Mach_Numbers , 

Gains-  ->  Mach_Number_Gains , 

Integrated_Signals  ■>  Throttle  Commands, 

Initial  Proportional_Gain  ■>  Initial_Hach_Error_Gain, 

Tustin_Integrate  ->  Ipp_Tus tin. Integrate); 


package  Tustin  is  nev  Signal_Processing. 

Tustin-Integrator  With  Asymmetric_Limit 


(Signals 
States 

Gained_Signals 

Gains 

Initial_Tustin_Gain 
Ini  tial[[Signal_Level 
Initial~State  ~ 


TEro  t  tTe_Commands7 
Throttle_Commands, 

Throt  tle^Commands , 

->  Throt tle~Commands, 

->  Initial_Throttle_Bandvidth, 
Ini t ial_Throt  tle_Comraand , 
Ini t ial~Throt tle~Command , 


.> 

-> 

-> 


-> 

•> 
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Initial_Signal_Lover_Limit  => 

Initial  Lover_Throttle_Command_Limit, 

Ini tial_Signal_Upper_LimIt  => 

Ini tial_Upper_Throttle_Command_Limi t) ; 

pragma  PAGE; 

function  Compute  Throttle_Command 

(MacE  Command  :  in  Mach_Numbers ; 

Mach~Feedback  :  in  Mach_Numbers) 

return  Throttle_Commands  is 

begin 

Mach_Error  :»  Mach_Command  -  Mach_Feedback; 

Mach_Error:»  Mach  Error_Limi ter. Limit  (Mach_Error) ; 

Rav_Throttle_Command  :*  Ipp_Gain. Integrate  (Signal  ->  Mach_Error); 

Throttle_Command_Rate  s  -  Raw_Throttle_Command  - 

S t o red_Th ro 1 1 le_Command ; 

Throttle_Command_Rate  Throttle_Command  Rate_Limiter. Limit 

(Throttle_Comman3_Rate) ; 

Stored_Throttle_Command  Tustin. Integrate 

(Signal  ->  Throttle_Command_Rate) ; 

return  StoredThrottleCommand; 

end  ComputeThrottleCommand; 

pragma  PAGE; 

procedure  Update_Mach_Error_Limit  (New_Limit  s  in  Mach_Numbers)  is 
begin 

Mach_Error_Limiter.Update_Limit  (New_Absolute_Limit  ->  New_Limit); 
end  Update_Mach_Error_Limit; 

pragma  PAGE; 

procedure  Update_Mach_Error_Integral  Limit 

(NewJLlmit  :  in  Throttle_Commands)  is 

begin 

Ipp  Tustin. Update_Limit  (New  Absolute_Limit  ->  New_Limit); 
end  Up3ate_Mach_Error_Integral_Eimi  t ; 

pragma  PAGE; 

procedure  Update_Throttle_Rate_Limit(New_Limit  :  in  Throttle_Commands)  is 
begin 

Thro  1 1  le_Command_Rate_Limi  ter .  Upda  te_Limi  t 

(New_Absolute_Limit  ->  New_Limit); 

end  Update_Throttle_Rate_Limit; 

pragma  PAGE; 

procedure  Update_Throttle_Command_Limi  ts 

(New_Lower_Limit  s  in  Throttle_Commands; 
New_Upper_Limit  :  in  Throttle_Commands)  is 

begin 

Tustin. Update_Limits  (Nev_Lover_Limit  ■>  New_Lower_Limit, 

New  Upper_Limit  »>  New~Upper_Limit) ; 
end  Update_Throttle_Conunand_Iimits; 

pragma  PAGE; 

procedure  Update_Mach  Error_Gain  (New_Gain  :  in  Mach_Number_Gains)  is 
begin 
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Ipp_Tustin.Update_Gain  (Nev_Gain  =>  Nev_Gain); 
end  Update_Mach_Error_Gain; 

pragma  PAGE; 

procedure  Update_Throttle_Bandvidth 

(Nev_Bandvidth  :  in  Throttle_Commands)  is 

begin 

Tustin. Update_Gain  (New  Gain  =>  New_Bandwidth) ; 
end  Update  Throttle  Bandwidth; 


pragma  PAGE; 


—  —  begin  processing  for  Throttle _ 

—  —  Command  Manager  package  body 


begin 

Mach_Error  0.0; 

Mach_Error:=  Mach_Error_Limi ter. Limit  (MachJBrror) ; 

Raw_Throttle_Conunand  :«  Initial_Throttle_Command; 
Stored_Throttle_Command  :«  0.0; 

Initiallpplntegral  :*  Raw  Throttle_Command  - 

MacKError  *  InitialMachErrorGain; 

IppTus tin. RESET  (Integrator_State  »>  Initial_Ipp_Integral, 
Signal  ->  Mach_Error); 

end  Thro  1 1 le_Command_Manager ; 

end  Fuel  Control  Parts; 


* 
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3.3.6  MATHEMATICAL 
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3.3.6. 1  COORDINATE  VECTOR  MATRIX  ALGEBRA  (BODY)  TLCSC  P681  (CATALOG  #P53-0) 

This  part  consists  of  generic  packages  and  functions  which  define  and/or 
operate  on  coordinate  vectors  and  matrices.  A  coordinate  vector  is  a 
three-element  array.  A  coordinate  matrix  is  a  3  x  3  array.  These  arrays  are 
dimensioned  with  scalar  types  defined  by  the  user. 

WARNING:  The  units  in  this  part  ASSUME  the  axes  types  used  to  dimension  the 
arrays  have  a  length  of  3.  If  they  do  not,  the  units  will  not  function 
properly.  No  length  checks  are  performed  by  the  units. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 6. 1.1  REQUIREMENTS  ALLOCATION 

The  following  chart  summarizes  the  allocation  of  CAMP  requirements  to  this 
TLCSC: 


|  Name 

1  Type 

Requirements  Allocation  | 

|  Vector  Operations 

|  generic  package 

R024, 

R050, 

R051, 

R052 

j  Matrix  Operations 

j  generic  package 

R070, 

R071, 

R060, 

R067,  R072 

i 

R078 

|  Vector  Scalar  Operations 

|  generic  package 

R054, 

R055 

j  Matrix  Scalar  Operations 

j  generic  package 

R056, 

R057 

j  Cross  Product 

j  generic  function 

R053 

1  Matrix  Vector  Multiply 

j  generic  function 

R049 

j  MatrixMatrixMultiply 

j  generic  function 

R068 

3. 3. 6. 1.2  LOCAL  ENTITIES  DESIGN 
None. 

3. 3. 6. 1.3  INPUT/OUTPUT 
None. 

3. 3. 6. 1.4  LOCAL  DATA 
None. 

3. 3.6. 1.5  PROCESS  CONTROL 


V 


Not  applicable. 
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3. 3. 6. 1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
with  General_Purpose_Math; 

package  body  Coordinate_Vector_Matrix_Algebra  is 

package  body  Matrix_Operations  is  separate; 

package  body  Matrix_Scalar_Operations  is  separate; 

function  Cross_Product  (Left  :  Lef t_Vectors; 

Right  :  Right_Vectors) 
return  Result_Vectors  is  separate; 

function  Matrix_Vector_Multiply  (Matrix  :  Matrices; 

Vector  :  Input_Vectors) 
return  Output_Vectors  is  separate; 

function  Matrix_Matrix_Multiply  (Matrixl  :  Lef t_Matrices; 

Matrix2  :  Right_Matrices) 
return  Result_Matrices  is  separate; 

end  Coordinate_Vector_Matrix_Algebra; 


3. 3. 6. 1.7  UTILIZATION  OF  OTHER  ELEMENTS 

The  following  library  units  are  with'd  by  this  part: 
1.  General_Purpose_Math  (GPMath) 


3. 3. 6. 1.8  LIMITATIONS 


None. 


3. 3. 6. 1.9  LLCSC  DESIGN 

3. 3. 6. 1.9.1  VECTOR  OPERATIONS  PACKAGE  DESIGN  (CATALOG  #P54-0) 

This  part,  which  is  a  package  body,  provides  general  operations  on 
three-element,  coordinate  vectors. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 6. 1.9. 1.1  REQUIREMENTS  ALLOCATION 

The  following  chart  summarizes  the  allocation  of  CAMP  requirements  to  this 
LLCSC. 
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1  Name 

1 

1 

Type 

1 

1 

Requirement 

Allocation 

1  +  11 

1 

function 

1 

R050 

fl  _  t» 

function 

1 

R051 

j  Dot  Product 

function 

1 

R052 

j  Length 

1 

function 

1 

R208 

|  Sparse  Right  Z  Add 

1 

function 

1 

R205 

j  Sparse  Right  X  Add 

1 

function 

1 

R206 

|  Sparse  Right  XY  Subtract 

1 

function 

1 

R207 

j  Set  to_Zero_Vector 

1 

function 

1 

N/A 

3. 3. 6. 1.9. 1.2  LOCAL  ENTITIES  DESIGN 
Subprograms: 

The  following  table  describes  the  subprograms  maintained  local  to  this  part: 


|  Name 

1  Type  | 

|  Description  | 

RSOS  | 

function  | 

Instantiated  version  of  General  Purpose  Math. General 

1 

Operations. Root  Sum  Of  SquaresJ  required  by  Length 

1 

function 

3. 3. 6. 1.9. 1.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

The  following  generic  parameters  were  previously  described  when  this  part  was 
specified: 

Data  types: 

The  following  table  describes  the  generic  formal  types  required  by  this  part: 


|  Name  |  Type  |  Description 


Axes 

Elements 

Elements_Squared 


scalar  type 
floating 
point  type 
floating 
point  type 


Used  to  dimension  the  exported  vector  type 
Data  type  of  elements  in  exported  vector 
type 

Data  type  resulting  from  multiplying  two 
objects  of  type  Elements 


Subprograms: 

The  following  table  describes  the  generic  formal  subroutines  required  by  this 
part: 
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|  Name 

1  Type 

Description 

1 

|  »*" 

|  function 

Multiplication  operator 

defining 

the  operation:  | 

1 

Elements  *  Elements  := 

Elements 

Squared  j 

1  Sqrt 

|  function 

Square  root  operator 

1 

3. 3. 6. 1.9. 1.4  LOCAL  DATA 


Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name  |  Type  |  Value  [  Description  | 


X 

1 

1 

Axes 

1 

Axes 'FIRST 

Y 

Axes 

1 

1 

l 

Axes' SUCC(x) 

Z 

1 

Axes 

1 

Axes 'LAST 

Zero_Vector 

1 

1 

Vectors 

0.0 

Constant  used  to  index  first  element 
in  vector 

Constant  used  to  index  second 
element  in  vector 

Constant  used  to  index  last  element 
in  vector 

Con t ant  vector  vhose  elements  have 
all  been  set  to  0.0 


3. 3. 6. 1.9. 1.5  PROCESS  CONTROL 
Not  applicable. 


3. 3. 6. 1.9. 1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
package  body  Vector_Operations  is 


— declaration  section- 


X  :  constant 
y  :  constant 
z  :  constant 

Zero  Vector  :  constant 


— local  funciions- 


function  RSOS  is  new 

General  Purpose_Ma th . Roo  t_Sum_of _Squares 
(ReaI_Type  «>  Elements, 


Axes  :■  Axes 'FIRST; 

Axes  :-  Axes' SUCC(X) ; 

Axes  : »  Axes 'LAST; 

Vectors  :-  (others  =•>  0.0); 


r  V  \ 
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$ 

Squared_Type  =>  Elements_Squared, 

Sqrt  =>  Sqrt); 

end  VectorOperations; 

3. 3. 6. 1.9. 1.7  UTILIZATION  OF  OTHER  ELEMENTS 

The  following  library  units  were  with'd  by  the  Coordinate_Vector  Matrix_Algebra 
TLCSC: 

1.  General_Purpose_Math  (GPMath) 

UTILIZATION  OF  EXTERNAL  ELEMENTS: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  external  subroutines  and  task  entries 


required  by  this 

part: 

|  Name  | 

Type  | 

|  Source 

|  Description  | 

|  Root_Sum_0f_ 

1  Squares 

generic 

function 

GPMath 

|  Performs  calculations  necessary  to  | 
compute  the  length  of  a  vector 

•  UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsevhere  in  the  parent  top  level  component: 

Data  types: 

The  following  data  types  were  previously  defined  in  the  specification  of  this 
part: 


|  Name 

Type 

|  Range 

|  Description  | 

|  Vectors 

array 

|  N/A 

|  One-dimensional  array  of  Elements  | 

3. 3. 6. 1.9. 1.8  LIMITATIONS 
None. 

3. 3. 6. 1.9. 1.9  LLCSC  DESIGN 
None. 
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3.3.6.1.9.1.10  UNIT  DESIGN 

3.3.6.1.9.1.10.1  "+"  UNIT  DESIGN  (CATALOG  #P693-0) 

This  unit,  which  is  a  function,  calculates  the  result  of  adding  two  vectors. 
Each  vector  has  components  in  the  x-,  y-,  and  z-axes  of  the  Cartesian 
coordinate  system. 


3.3.6.1.9.1.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R050. 


3.3.6.1.9.1.10.1.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.1.10.1.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode  | 

|  Description 

1 

|  Left 

|  Vectors  | 

1  In  | 

First  vector 

to  be  added  | 

I  Right 

j  Vectors  j 

1  In  | 

|  Second  vector 

to  be  added  | 

3.3.6.1.9.1.10.1.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Answer  | 

|  Vectors 

|  Result  of  adding  two  input  vectors  | 

3.3.6.1.9.1.10.1.5  PROCESS  CONTROL 


Not  applicable. 


3.3.6.1.9.1.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  "+"  (Left  :  Vectors; 

Right  :  Vectors)  return  Vectors  is 
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— declaration  section- 


Answer  :  Vectors; 


— function  body- 


begin 

Ansver(X)  :«  Left(X)  +  Right(X); 
Ansver(Y)  :«  Left(Y)  +  Right(Y); 
Answer(Z)  Left(Z)  +  Right(Z); 

return  Answer; 

end  "+"; 


3.3.6.1.9.1.10.1.7  UTILIZATION  OP  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  top  level  component: 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  formal  parameters  to  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 


j  Name 

1  Type 

|  Description  | 

|  Axes 
j  Elements 

1  1 

scalar  type 
floating 
point  type 

Used  to  dimension  the  exported  vector  type| 
Data  type  of  elements  in  exported  vector  j 
type  | 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
the  package  specification  of  the  Coordinate_Vector_Matrix_Algebra. Vector  - 
Operations  LLCSC: 


|  Name 

Type 

|  Range 

|  Description  | 

|  Vectors 

array 

|  N/A 

|  One-dimensional  array  of  Elements  | 

Data  objects: 
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The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  the  Coordinate_Vector_Matrix_Algebra.Vector_Operations 
LLCSC: 


|  Name  |  Type  |  Value  |  Description 


X 

1 

| 

Axes 

|  Axes 'FIRST 

i 

Y 

1 

1 

Axes 

1 

|  Axes'SUCC(x) 

Z 

1 

Axes 

|  Axes' LAST 

1 

Constant  used  to  index  first  element 
in  vector 

Constant  used  to  index  second 
element  in  vector 

Constant  used  to  index  last  element 
in  vector 


3.3.6.1.9.1.10.1.8  LIMITATIONS 


None. 


3.3.6.1.9.1.10.2  UNIT  DESIGN  (CATALOG  #P694-0) 

This  unit,  which  is  a  function,  calculates  the  result  of  subtracting  two 
vectors.  Each  vector  has  components  in  the  x-,  y-,  and  z-axes  of  the  Cartesian 
coordinate  system. 


3.3.6.1.9.1.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R051. 


3.3.6.1.9.1.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.1.10.2.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode 

|  Description 

1 

|  Left 

|  Vectors 

1  1" 

|  Vector  to  be 

subtracted  from  j 

1  Right 

|  Vectors 

1  In 

|  Vector  to  be 

used  as  the  subtrahend  | 

3.3.6.1.9.1.10.2.4  LOCAL  DATA 
Data  objects: 
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The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Answer  | 

|  Vectors 

|  Result  of  subtracting  two  input  vectors  | 

3.3.6.1.9.1.10.2.5  PROCESS  CONTROL 


Not  applicable. 


3.3.6.1.9.1.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  (Left  :  Vectors; 

Right  :  Vectors)  return  Vectors  is 

— declaration  section- 


Answer  :  Vectors; 


— function  body- 


begin 

Ansver(X)  Left(X)  -  Right(X); 

Answer(Y)  Left(Y)  -  Right(Y); 

Answer(Z)  Left(Z)  -  Right(Z); 

return  Answer; 

end 


3.3.6.1.9.1.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  top  level  component: 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  formal  parameters  to  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 
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|  Name 

1  Type 

Description  | 

|  Axes 
j  Elements 

1 

|  scalar  type 
j  floating 
;  point  type 

Used  to  dimension  the  exported  vector  type) 
Data  type  of  elements  in  exported  vector  | 
type  | 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
the  package  specification  of  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 


|  Name 

Type 

|  Range 

|  Description  | 

|  Vectors 

array 

|  N/A 

|  One-dimensional  array  of  Elements  | 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  the  Coordinate_Vector_Matrix_Algebra.Vector_Operations 
LLCSC: 


|  Name  |  Type  |  Value  |  Description 


X 

|  Axes 

|  Axes 'FIRST 

Y 

|  Axes 

1 

|  Axes' SUCC(x) 

Z 

1 

|  Axes 

1 

j  Axes 'LAST 

1 

Constant  used  to  index  first  element 
in  vector 

Constant  used  to  index  second 
element  in  vector 

Constant  used  to  index  last  element 
in  vector 


3.3.6.1.9.1.10.2.8  LIMITATIONS 


None. 


3.3.6.1.9.1.10.3  VECT0R_LENGTH  UNIT  DESIGN  (CATALOG  #P55-0) 

This  unit,  which  is  a  function,  calculates  the  length  of  a  coordinate  vector. 
The  vector  has  components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian  coordinate 
system. 


3.3.6.1.9.1.10.3.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R208. 
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3.3.6.1.9.1.10.3.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.6.1.9.1.10.3.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type  | 

Mode 

|  Description  | 

|  Vector 

|  Vectors 

1  In 

|  Vector  for  which  a  length  is  to  be  calculated  | 

3.3.6.1.9.1.10.3.4  LOCAL  DATA 


None. 


3.3.6.1.9.1.10.3.5  PROCESS  CONTROL 
Not  applicable. 


3.3.6.1.9.1.10.3.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  Vector_Length  (Vector  :  Vectors)  return  Elements  is 
begin 

return  RSOS(Vector(X) ,  Vector(Y),  Vector(Z))j 
end  Vector_Length; 


3.3.6.1.9.1.10.3.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  in  the  package  body  of  the  Coordinate_Vector_Matrix_- 
Algebra.Vector_Operations  LLCSC: 
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|  Name 

1  Type  | 

Description 

1 

|  RSOS 

1 

|  function  | 

1  1 

Instantiated  version  of 
Operations. Root  Sum  Of 

General_Purpose_Math. General  | 
Squares  j 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  formal  parameters  to  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 


|  Name 

1  Type 

Description  | 

|  Axes 
j  Elements 

1 

j  scalar  type 
j  floating 
j  point  type 

Used  to  dimension  the  exported  vector  type| 
Data  type  of  elements  in  exported  vector  j 
type  j 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
the  package  specification  of  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 


|  Name 

Type 

|  Range 

|  Description  | 

|  Vectors 

array 

|  N/A 

|  One-dimensional  array  of  Elements  | 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  the  Coordinate  Vector_Matrix_Algebra.Vector_Operations 
LLCSC: 


|  Name  |  Type  |  Value  |  Description 


X 

j  Axes 

i 

|  Axes' FIRST 

1 

Y 

1 

|  Axes 

l 

|  Axes' SUCC(x) 

Z 

|  Axes 

1 

j  Axes 'LAST 

1 

Constant  used  to  index  first  element 
in  vector 

Constant  used  to  index  second 
element  in  vector 

Constant  used  to  index  last  element 
in  vector 


3.3.6.1.9.1.10.3.8  LIMITATIONS 
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3.3.6.1.9.1.10.4  D0T_PR0DUCT  UNIT  DESIGN  (CATALOG  #P56-0) 

This  unit,  which  is  a  function,  calculates  the  dot  product  of  two  vectors. 

Each  vector  has  components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian  coordinate 
system. 


3.3.6.1.9.1.10.4.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R052. 


3.3.6.1.9.1.10.4.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.1.10.4.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode 

|  Description  | 

|  Vectorl 
! 

|  Vectors  | 

In 

First  vector  to  be  used  for  the  dot  product 
operation 

j  Vector2 

1  1 

|  Vectors  | 

1  I 

In 

Second  vector  to  be  used  for  the  dot  product 
operation 

3.3.6.1.9.1.10.4.4  LOCAL  DATA 
Data  objects:  , 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name  | 

|  Type 

|  Description  | 

|  Answer  | 

Elements 

|  Result  of  performing  a  dot  product  operation  | 

3.3.6.1.9.1.10.4.5  PROCESS  CONTROL 


Not  applicable. 


3.3.6.1.9.1.10.4.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  Dot_Product  (Vectorl  :  Vectors; 

Vector2  :  Vectors)  return  Elements_Squared  is 
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— declaration  section- 


Ansver  :  Elements  Squared; 


— function  body- 


begin 

Answer  Vectorl(X)  *  Vector2(X)  + 
Vectorl(Y)  *  Vector2(Y)  + 
Vectorl(Z)  *  Vector2(Z); 

return  Answer; 

end  Dot  Product; 


3.3.6.1.9.1.10.4.7  UTILIZATION  OP  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  top  level  component: 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  formal  parameters  to  the  Coordinate_Vector_Matrix_Algebra. Vector  - 
Operations  LLCSC: 


|  Name 

Type 

Description  | 

Axes 

scalar  type 

Used  to  dimension  the  exported  vector  type 

Elements 

floating 

Data  type  of  elements  in  exported  vector 

point  type 

type 

Elements  Squared 

floating 

Data  type  resulting  from  multiplying  two 

point  type 

objects  of  type  Elements 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
the  package  specification  of  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 


|  Name 

Type 

|  Range 

|  Description  | 

|  Vectors 

array 

|  N/A 

|  One-dimensional  array  of  Elements  | 
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Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  the  Coordinate_Vector  Matrix_Algebra. Vector_Operations 
LLCSC: 


|  Name  |  Type  |  Value  |  Description  | 


X 

|  Axes 

1 

|  Axes' FIRST 

Y 

1 

|  Axes 

1 

j  Axes' SUCC(x) 

l 

Z 

|  Axes 

1 

j  Axes ' LAST 

1 

Constant  used  to  index  first  element 
in  vector 

Constant  used  to  index  second 
element  in  vector 

Constant  used  to  index  last  element 
in  vector 


3.3.6.1.9.1.10.4.8  LIMITATIONS 


None. 


3.3.6.1.9.1.10.5  SPARSE  RIGHT  Z  ADD  UNIT  DESIGN  (CATALOG  #P57-0) 

This  unit,  which  is  a  function,  calculates  the  addition  of  two  vectors.  Each 
vector  has  components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian  coordinate 
system.  The  z-component  of  the  second  vector  equals  0. 


3.3.6.1.9.1.10.5.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R205. 


3.3.6.1.9.1.10.5.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.1.10.5.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode 

|  Description  | 

|  Left 

|  Vectors 

1  In 

|  First  vector  to  be  added 

1  Right 

j  Vector 

1  In 

j* Second  vector  to  be  added;  j 

1 

1 

j  z-component  equals  0  j 
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3.3.6.1.9.1.10.5.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Answer 

|  Vectors 

|  Result  of  adding  two  input  vectors  | 

3.3.6.1.9.1.10.5.5  PROCESS  CONTROL 


Not  applicable. 


3.3.6.1.9.1.10.5.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  Sparse_Right_Z_Add  (Left  :  Vectors; 

Right  :  Vectors)  return  Vectors  is 


.-declaration  section- 


Answer  :  Vectors; 


— function  body- 


begin 

Ansver(X)  :»  Left(X)  +  Right(X); 
Ansver(Y)  Left(Y)  +  Right(Y); 
Answer(Z)  :»  Left(Z); 

return  Ansver; 

end  Sparse_Right  L_Add; 


3.3.6.1.9.1.10.5.7  UTILIZATION  OP  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  top  level  component: 


Data  types: 


s  s 
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The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  formal  parameters  to  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 


|  Name 

1  Type 

Description  | 

|  Axes 
j  Elements 

1 

|  scalar  type 
j  floating 
j  point  type 

Used  to  dimension  the  exported  vector  type| 
Data  type  of  elements  in  exported  vector  j 
type  j 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
the  package  specification  of  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 


|  Name 

Type 

|  Range 

|  Description  | 

|  Vectors 

array 

|  N/A 

|  One-dimensional  array  of  Elements  | 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  the  Coordinate_Vector_Matrix_Algebra.Vector_Operations 
LLCSC: 


|  Name 

I  Type 

Value 

Description  | 

1  x 

1 

|  Axes 

1 

Axes' PIRST 

Constant  used  to  index  first  element | 
in  vector  j 

j  y 

1 

|  Axes 

1 

Axes' SUCC(x) 

Constant  used  to  index  second  j 

element  in  vector 

j  z 

1 

|  Axes 

1 

Axes 'LAST 

Constant  used  to  index  last  element  j 
in  vector  j 

3.3.6.1.9.1.10.5.8  LIMITATIONS 


None. 


3.3.6.1.9.1.10.6  SPARSE  RIGHT  X  ADD  UNIT  DESIGN  (CATALOG  #P58-0) 

This  unit,  which  is  a  function,  calculates  the  result  of  adding  two  vectors. 
Each  vector  has  components  in  the  x-,  y-,  and  z-axes  of  the  Cartesian 
coordinate  system.  The  x-component  of  the  second  vector  equals  0. 


3.3.6.1.9.1.10.6.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R206. 
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3.3.6.1.9.1.10.6.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.1.10.6.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode 

|  Description  | 

|  Left 

j  Vectors 

In 

|  First  vector  to  be  added  | 

I  Right 

1 

j  Vectors 

1  1 

In 

j  Second  vector  to  be  added;  x-component  j 
j  equals  0  j 

3.3.6.1.9.1.10.6.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Answer  | 

|  Vectors 

|  Result  of  adding  two  input  vectors  | 

3.3.6.1.9.1.10.6.5  PROCESS  CONTROL 


Not  applicable. 


3.3.6.1.9.1.10.6.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  Sparse_Right_X_Add  (Left  :  Vectors; 

Right  :  Vectors)  return  Vectors  is 


— declaration  section- 


Answer  :  Vectors; 


— function  body- 


begin 
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Answer(X)  :=  Left(X); 

Answer(Y)  :=  Left(Y)  +  Right(Y); 
Answer(Z)  :=  Left(Z)  +  Right(Z); 

return  Answer; 

end  Sparse_Right_X_Add; 


3.3.6.1.9.1.10.6.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  top  level  component: 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  formal  parameters  to  the  Coordinate_Vector_Matrix_Algebra. Vector  - 
Operations  LLCSC: 


|  Name 

1  Type 

|  Description  | 

SilA 

1 

|  Axes 
|  Elements 

1 

|  scalar  type 
|  floating 
j  point  type 

Used  to  dimension  the  exported  vector  type 
Data  type  of  elements  in  exported  vector 
type 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
the  package  specification  of  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 


|  Name 

Type 

|  Range 

|  Description  | 

|  Vectors 

array 

|  N/A 

|  One-dimensional  array  of  Elements  | 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  the  Coordinate_Vector  Matrix  Algebra. Vector_Operations 
LLCSC: 


Name 

1  Type 

Value 

I 

Description 

1 

X 

|  Axes 

Axes 'FIRST 

7 

Constant  used  to  index 

first  element 

1 

in  vector 

Y 

|  Axes 

Axes' SUCC(x) 

i 

Constant  used  to  index 

second 

element  in  vector 

Z 

|  Axes 

Axes 'LAST 

i 

Constant  used  to  index 

last  element 

1 

i 

in  vector 
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3.3.6.1.9.1.10.6.8  LIMITATIONS 
None. 


3.3.6.1.9.1.10.7  SPARSE  RIGHT  XY  SUBTRACT  UNIT  DESIGN  (CATALOG  #P59-0) 

This  unit,  which  is  a  function,  calculates  the  result  of  subtracting  two 
vectors.  Each  vector  has  components  in  the  x-,  y-,  and  z-axes  of  the  Cartesian 
coordinate  system.  The  x-  and  y-components  of  the  second  vector  equal  0. 


3.3.6.1.9.1.10.7.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R207. 


3.3.6.1.9.1.10.7.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.1.10.7.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

Mode 

|  Description  | 

|  Left 

|  Vectors 

In 

|  First  vector  to  be  used  in  subtraction  | 

|  Right 

j  Vectors 

In 

j  Second  vector  to  be  used  in  subtraction;  x-  \ 

1 

1 

j  and  y-  components  equal  0  j 

3.3.6.1.9.1.10.7.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 

|  Name  |  Type  |  Description  | 

|  Answer  |  Vectors  |  Result  of  subtracting  two  input  vectors  | 


3.3.6.1.9.1.10.7.5  PROCESS  CONTROL 
Not  applicable. 
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3.3.6.1.9.1.10.7.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  Sparse_Right_XY_Sub tract  (Left  :  Vectors; 

Right  :  Vectors)  return  Vectors  is 


— declaration  section- 


Answer  :  Vectors; 


— function  body- 


begin 

Answer(X)  :*  i «5 f t (X) ; 

Answer(Y)  :=»  Lfeft(Y); 

Answer(Z)  :»  Left(Z)  -  Right(Z); 

return  Answer; 

end  Sparse_Right_XY_Subtract; 


3*. 3. 6. 1.9. 1.10. 7. 7  UTILIZATION  OP  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  top  level  component: 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  formal  parameters  to  the  Coordinate_Vector_Matrix_Algebra.Vec:or_- 
Operations  LLCSC: 


|  Name 

1  Type 

|  Description  | 

|  Axes 
j  Elements 

1 

|  scalar  type 
j  floating 
|  point  type 

Used  to  dimension  the  exported  vector  type| 
Data  type  of  elements  in  exported  vector 
type  j 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
the  package  specification  of  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 
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|  Name 

Type 

I  Range  | 

Description  | 

|  Vectors 

array 

|  N/A  | 

One-dimensional  array  of  Elements  | 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  the  Coordinate_Vector_Matrix_Algebra.Vector_Operations 
LLCSC: 


|  Name  |  Type  |  Value  |  Description 


Constant  used  to  index  first  element 
in  vector 

Constant  used  to  index  second 
element  in  vector 

Constant  used  to  index  last  element 
in  vector 


3.3.6.1.9.1.10.7.8  LIMITATIONS 


!  X 

|  Axes 

|  Axes 'FIRST 

l 

1  Y 

1 

|  Axes 

l 

|  Axes' SUCC(x) 

1  z 

1 

|  Axes 

j  Axes 'LAST 

1 

None. 


3.3.6.1.9.1.10.8  SETT0ZER0VECT0R  UNIT  DESIGN  (CATALOG  #P60-0) 

This  function  returns  a  vector  whose  elements  have  all  been  set  to  0.0. 


3.3.6.1.9.1.10.8.1  REQUIREMENTS  ALLOCATION 
N/A 


3.3.6.1.9.1.10.8.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.1.10.8.3  INPUT/OUTPUT 


None. 


3.3.6.1.9.1.10.8.4  LOCAL  DATA 


None. 
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3.3.6.1.9.1.10.8.5  PROCESS  CONTROL 


Not  applicable. 


3.3.6.1.9.1.10.8.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  parts 
function  Set_to_Zero_Vector  return  Vectors  is 
begin 

return  Zero_Vector; 
end  Set  to  Zero  Vector; 


3.3.6.1.9.1.10.8.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsevhere  in  the  top  level  component: 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  formal  parameters  to  the  Coordinate^Vector_Matrix_Algebra. Vector  - 
Operations  LLCSC: 


|  Name 

1  Type  | 

|  Description  | 

|  Axes 
|  Elements 

1 

|  scalar  type 
j  floating 
j  point  type 

|  Used  to  dimension  the  exported  vector  type 
|  Data  type  of  elements  in  exported  vector 

1  type 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  in 
the  package  specification  of  the  Coordinate_Vector_Matrix_Algebra. Vector- 
Operations  LLCSC: 


|  Name 

Type 

|  Range 

|  Description 

1 

|  Vectors 

array 

|  N/A 

|  One-dimensional  array  of  Elements 

1 

Data  objects: 

The  following  table  summarizes  the  objects  required  by  this  part  and  defined  in 
the  package  body  of  the  Coordinate  Vector_Matrix_Algebra. Vector  Operations 
LLCSC: 


li 


l  ) 
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|  Name 

Type 

Value 

|  Description  | 

|  Zero  Vector 

1 

Vectors 

0.0 

|  Contant  vector  whose  elements  have  | 

|  all  been  set  to  0.0 

3.3.6.1.9.1.10.8.8  LIMITATIONS 
None. 

3. 3. 6. 1.9. 2  VECT0R_SCALAR_0PERATI0NS  (BODY)  PACKAGE  DESIGN  (CATALOG  #P64-0) 

This  LLCSC  provides  the  functions  to  allow  multiplication  or  division  of  each 
element  of  a  vector  by  a  scalar. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 

3. 3. 6. 1.9. 2.1  REQUIREMENTS  ALLOCATION 

The  following  chart  summarizes  the  allocation  of  requirements  to  this  part: 


|  Name 

Requirement  Allocation  | 

| 

R054  | 

j  Sparse  X  Vector  Scalar  Multiply 

R209  j 

j  "/" 

R055  | 

3. 3. 6. 1.9. 2. 2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.6. 1.9. 2. 3  INPUT/OUTPUT 
None. 

3. 3. 6. 1.9. 2. 4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 
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|  Name 

1  Type 

Description 

1 

1  x 

|  constant  Axes 

Used  to  index 

first  element  in  vector  | 

1  y 

j  constant  Axes 

Used  to  index 

second  element  in  vector  j 

1  z 

|  constant  Axes 

Used  to  index 

last  element  in  vector  | 

3. 3. 6. 1.9. 2. 5  PROCESS  CONTROL 


Not  applicable. 


3. 3. 6. 1.9. 2. 6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 
package  body  Vector_Scalar_Operations  is 


— declaration  section- 


x  :  constant  Axes  Axes'FIRST; 
y  :  constant  Axes  :«  Axes' SUCC(x) ; 
z  :  constant  Axes  :*  Axes 'LAST; 

end  VectorScalarOperations; 


3. 3. 6. 1.9. 2. 7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3. 3. 6. 1.9. 2. 8  LIMITATIONS 


None. 

3. 3. 6. 1.9. 2. 9  LLCSC  DESIGN 


None. 


3.3.6.1.9.2.10  UNIT  DESIGN 

3.3.6.1.9.2.10.1  UNIT  DESIGN  (CATALOG  #P700-0) 

This  unit,  which  is  a  function,  multiples  each  element  of  a  vector  by  a  scalar. 
The  vector  has  3  elements  which  are  components  in  the  x-,  y-,  and  z-axes  of  a 
Cartesian  coordinate  system. 
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3.3.6.1.9.2.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R054. 


3.3.6.1.9.2.10.1.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.2.10.1.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 


|  Name 

1  Type 

|  Mode 

|  Description  | 

|  Vector 

|  Vectorsl 

1  1" 

|  Vector  to  be  scaled  | 

j  Multiplier 

1  1 

|  Scalars 

1 

1  In 

1 

j  Value  to  be  used  when  multiplying  the  j 
i  elements  of  the  vector  j 

3.3.6.1.9.2.10.1.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

Type 

Description  | 

|  Answer 

Vectors2 

Scaled  vector  as  calculated  by  this  part  | 

3.3.6.1.9.2.10.1.5  PROCESS  CONTROL 
Not  applicable. 

3.3.6.1.9.2.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  (Vector  :  Vectorsl; 

Multiplier  :  Scalars)  return  Vectors2  is 

— declaration  section- 

Answer  :  Vectors2; 


— begin  function 
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begin 


Answer (x) 
Answer (y) 
Answer(z) 


Vector(x) 

Vector(y) 

Vector(z) 


*  Multiplier; 

*  Multiplier; 

*  Multiplier; 


return  Answer; 
end 


3.3.6.1.9.2.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  as  generic  parameters  to  the  Coordinate  Vector_Matrix_- 
Algebra. Vector_Scalar_Operations  LLCSC: 


|  Name 

1  Type 

|  Description  | 

|  "*« 

1 

|  function 

1 

Multiplication  operator  used  to  define  the  operation:  | 
Elemental  *  Scalars  : -  Element s2  j 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  parameters  to  the  Coordinate_Vector_Matrix_Algebra.Vector_Scalar_- 
Operations  LLCSC: 


|  Name  |  Type  |  Description 


|  Axes 

scalar  type  |  Used  to  dimension  imported  vector  types 

|  Elements 1 

floating  j  Type  of  elements  on  Vectorsl 

1 

point  type  j 

|  Elements2 

floating  j  Type  of  elements  on  Vectors2 

1 

point  type  j 

|  Scalars 

floating  j  Data  type  of  scale  factors 

1 

point  type  j 

3.3.6.1.9.2.10.1.8  LIMITATIONS 


None. 
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3.3.6.1.9.2.10.2  "/"  UNIT  DESIGN  (CATALOG  #P699-0) 

This  unit,  which  is  a  function,  provides  the  capability  to  divide  each  element 
of  a  vector  by  a  scalar.  The  vector  has  three  elements  which  are  components  in 
the  x-,  y-,  and  z-axes  of  a  Cartesian  coordinate  system. 


3.3.6.1.9.2.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R055. 


3.3.6.1.9.2.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.2.10.2.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Node  |  Description  | 

|  Vector  | 
j  Divisor 

1  1 

|  Vector2 
j  Scalars 

|  In  |  Vector  to  be  scaled 

j  j  Value  each  element  of  the  vector  is  to 

j  j  be  divided  by 

3.3.6.1.9.2.10.2.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Answer  | 

|  Vectorsl 

|  Scaled  vector  as  calculated  by  this  part  | 

3.3.6.1.9.2.10.2.5  PROCESS  CONTROL 


Not  applicable. 


3.3.6.1.9.2.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  "/"  (Vector  :  Vectors2; 

Divisor  :  Scalars)  return  Vectorsl  is 
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— declaration  section- 


Answer  :  Vectorsl; 


— begin  function  "/" 


begin 

Ansver(x)  :*  Vector(x)  /  Divisor; 

Answer(y)  Vector(y)  /  Divisor; 

Ansver(z)  :«  Vector(z)  /  Divisor; 

return  Answer; 

end  "/"; 


3.3.6.1.9.2.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 
UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  as  generic  parameters  to  the  Coordinate_Vector_Matrix_- 
Algebra. Vector_Scalar_Operations  LLCSC: 


|  Name 

1  Type 

Description  | 

|  "/" 

1 

|  function 

1 

Division  operator  used  to  define  the  operation:  j 

Elements2  /  Scalars  :>  Elements!  j 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part  and  defined  as 
generic  parameters  to  the  Coordinate_Vector_Matrix_Algebra.Vector_Scalar_- 
Operations  LLCSC: 
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j  Name  |  Type  |  Description 


Axes 

Elementsl 

Elements2 

Scalars 


scalar  type 
floating 
point  type 
floating 
point  type 
floating 
point  type 


Used  to  dimension  imported  vector  types 
Type  of  elements  on  Vectorsl 

Type  of  elements  on  Vectors2 

Data  type  of  scale  factors 


3.3.6.1.9.2.10.2.8  LIMITATIONS 


None. 


3.3.6.1.9.2.10.3  SPARSE  X  VECTOR  SCALAR  MULTIPLY  UNIT  DESIGN  (CATALOG  #P65-0) 

This  unit,  which  is  a  function,  provides  the  capability  to  multiply  each 
element  of  a  vector  by  a  scalar.  The  vector  has  3  elements  which  are 
components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian  coordinate  system.  The 
x-component  of  the  vector  equals  0. 


3.3.6.1.9.2.10.3.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R209. 


3.3.6.1.9.2.10.3.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.2.10.3.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

Type 

|  Mode 

Description  | 

|  Vector 

1 

Vectorsl 

1  In 

1 

Vector  to  be  scaled;  x-component  | 

equals  0  j 

j  Multiplier 

1 

Scalars 

1  In 

1 

Value  each  vector  element  is  | 

multiplied  by  | 

3.3.6.1.9.2.10.3.4  LOCAL  DATA 
Data  objects: 
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The  following  table  describes  the  data  objects  maintained  by  this  part: 


j  Name 

1  Type 

|  Description  | 

|  Answer 

|  Vectors2 

|  Scaled  vector  as  calculated  by  this  part  | 

3.3.6.1.9.2.10.3.5  PROCESS  CONTROL 


Not  applicable. 


3.3.6.1.9.2.10.3.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  Sparse_X_Vector_Scalar_Multiply 
(Vector  :  Vectorsl; 

Multiplier  :  Scalars)  return  Vectors2  is 


— declaration  section- 


Ansver  :  Vectors2; 


—begin  function  Sparse_X_Vector_Scalar_Multiply 


begin 

Answer(X)  :-  0.0; 

Answer(Y)  :«  Vector(Y)  *  Multiplier; 
Answer(Z)  :■  Vector(Z)  *  Multiplier; 

return  Answer; 

end  Sparse_X_Vec  t  or_Scalar_Mul  t  i  ply ; 


3.3.6.1.9.2.10.3.7  UTILIZATION  OF  OTHER  ELEMENTS 

UTILIZATION  OF  OTHER  ELEMENTS  IN  TOP  LEVEL  COMPONENT: 

The  following  tables  describe  the  elements  used  by  this  part  but  defined 
elsewhere  in  the  parent  top  level  component: 

Subprograms  and  task  entries: 

The  following  table  summarizes  the  subroutines  and  task  entries  required  by 
this  part  and  defined  as  generic  parameters  to  the  Coordinate_Vector_Matrix_- 
Algebra.Vector_Scalar_Operations  LLCSC: 
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|  Name  | 

Type  |  Description 

1 

|  •'*»  | 

function  |  Multiplication  operator  used  to  define  the  operation: 

1 

I  1 

|  Elementsl  *  Scalars  :=  Elements2 

i 

Data  types: 

The  following  table  summarizes  the  types  required  by  this  part 

and  defined 

as 

generic  parameters  to  the 

Coordinate  Vector  Matrix  Algebra. Vector  Scalar  - 

Operations  LLCSC: 

|  Name 

1  Type 

j  Description 

1 

|  Axes 

|  scalar  type 

|  Used  to  dimension  imported  vector 

types 

1 

j  Elementsl 

j  floating 

j  Type  of  elements  on  Vectorsl 

1 

1 

|  point  type 

1 

|  Elements2 

j  floating 

|  Type  of  elements  on  Vectors2 

1 

point  type 

j  Scalars 

j  floating 

|  Data  type  of  scale  factors 

1 

j  point  type 

1 

1 

3.3.6.1.9.2.10.3.8  LIMITATIONS 


None. 


3. 3. 6. 1.9. 3  MATRIX  OPERATIONS  PACKAGE  DESIGN  (CATALOG  #P61-0) 

This  package  provides  general  operations  on  a  two-dimensional  coordinate 
matrix. 

The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 


3. 3. 6. 1.9. 3.1  REQUIREMENTS  ALLOCATION 

The  following  chart  summarizes  the  allocation  of  requirements  to  this  part's 
units: 


Name 


Type 


1 

"+"  (matrices  +  matrices) 

function 

1 

R070 

1 

1 

(matrices  -  matrices) 

function 

1 

R071 

1 

"+"  (matrices  +  elements) 

function 

1 

R060 

(matrices  -  elements) 

function 

1 

R067 

1 

1 

Set  To  Identity  Matrix 

function 

1 

R072 

1 

Set_To_Zero_Matrix 

function 

1 

R078 

1 

Requirement 

Allocation 
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3.3.6. 1.9. 3. 2  LOCAL  ENTITIES  DESIGN 
None. 


3.3.6. 1.9. 3. 3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Previously  described  in  package  specification. 


3. 3. 6. 1.9. 3. 4  LOCAL  DATA 


Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type 

Value 

Description  | 

X 

|  Axes 

1 

Axes 'FIRST 

Constant  used  to  index  first  element 
in  matrix  row  and/or  column 

y 

|  Axes 

1 

Axes' SUCC(X) 

Constant  used  to  index  second  element 
in  matrix  row  and/or  column 

z 

|  Axes 

Axes 'LAST 

Constant  used  to  index  last  element 
in  matrix  row  and/or  column 

Identity 

j  Matrices 

Identity  matrix  with  diagonal 

Matrix 

1 

1 

• 

elements  set  to  1.0  and  all  other 
elements  set  to  0.0 

Zero_ 

Matrix 

|  Matrices 

1 

0.0 

Constant  zero  matrix  vith  all 
elements  set  to  0.0 

3.3.6. 1.9. 3. 5  PROCESS  CONTROL 


Not  applicable. 


3.3.6. 1.9. 3. 6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Coordinate_Vector_Matrix_Algebra) 
package  body  Matrix_Ope rat ions  is 


—  — declaration  section- 


X  :  constant  Axes  Axes 'FIRST; 

Y  :  constant  Axes  Axes' SUCC(X) ; 

Z  :  constant  Axes  :»  Axes' LAST; 

—  — the  diagonal  elements  of  Identity_Matrix  will  be  set  to  1.0  during 

—  — package  initialization 
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Identity_Matrix  :  Matrices  :=  (others  =>  (others  =>  0.0)); 
ZeroMatrix  :  constant  Matrices  :=  (others  =>  (others  =>  0.0)); 

—  — subroutine  bodies- 

function  Set_to_Identity_Matrix  return  Matrices  is  separate; 
function  Set_to_Zero_Matrix  return  Matrices  is  separate; 


— begin  package  Matrix_0perations- 


begin 

—  — initialize  diagonal  elements  of  Identity_Matrix,  remaining  elements  have 

—  — already  been  set  to  0.0 

Identity_Matrix(X,X)  :■  1.0; 

Identity_Matrix(Y,Y)  1.0; 

Identity_Matrix(Z,Z)  s-  1.0; 

end  MatrixOperations; 


3. 3. 6. 1.9. 3. 7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 


3. 3. 6. 1.9. 3. 8  LIMITATIONS 
None. 


3.3.6. 1.9. 3. 9  LLCSC  DESIGN 
None. 


3.3.6.1.9.3.10  UNIT  DESIGN 


3.3.6.1.9.3.10.1  "+"  (MATRICES  +  MATRICES)  UNIT  DESIGN  (CATALOG  #P695-0) 


This  unit,  which  is  a  function, 
result  of  adding  two  matrices, 
which  are  components  in  the  x-, 
system. 


provides  the  capability  to  calculated  the 
Each  matrix  is  a  3  x  3  matrix  having  9  elements 
y-,  a..d  z-axes  of  a  Cartesian  coordinate 
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3.3.6.1.9.3.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R070. 

3.3.6.1.9.3.10.1.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.6.1.9.3.10.1.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode  | 

Description 

1 

|  Left 

|  Matrices 

1  I"  | 

First  matrix 

to  be  added  | 

1  Right 

j  Matrices 

I  In  | 

Second  vector 

to  be  added  j 

3.3.6.1.9.3.10.1.4 

LOCAL  DATA 

Data  objects: 

The  folloving  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Answer  | 

|  Matrices 

|  Result  of  adding  tvo  input  matrices  | 

3.3.6.1.9.3.10.1.5  PROCESS  CONTROL 
Not  applicable. 

3.3.6.1.9.3.10.1.6  PROCESSING 

The  folloving  describes  the  processing  performed  by  this  part: 

function  "+"  (Left  :  Matrices; 

Right  :  Matrices)  return  Matrices  is 

— declaration  section- 

Ansver  :  Matrices; 

—  — begin  function  "+"  (matrices  +  matrices) 
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begin 

Ansver(X,X) 
Answer(X, Y) 
Answer(X,Z) 


Left(X.X)  +  Right(X,X) ; 
Lef t(X, Y)  +  Right(X,Y); 
Left(X,Z)  +  Right(X,Z); 


Answer(Y,X) 
Answer(Y,Y) 
Answer (Y, Z) 


Left(Y,X)  +  Right(Y,X) ; 
Lef t(Y, Y)  +  Right(Y,Y); 
Lef t(Y,Z)  +  Right(Y,Z); 


Answer(Z,X) 
Answer (Z, Y) 
Ansver(Z,Z) 


Lef t(Z,X)  +  Right(Z,X) ; 
Lef t(Z, Y)  +  Right(Z,Y); 
Lef t(Z,Z)  +  Right(Z,Z) ; 


return  Answer; 
end  " + M ; 


3.3.6.1.9.3.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 


None. 


3.3.6.1.9.3.10.1.8  LIMITATIONS 


None. 


3.3.6.1.9.3.10.2  (MATRICES  -  MATRICES)  UNIT  DESIGN  (CATALOG  #P696-0) 

This  unit,  which  is  a  function,  provides  the  capability  to  calculate  the  result 
of  subtraction  two  matrices.  Each  matrix  is  a  3  x  3  matrix  having  9  elements 
which  are  components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian  coordinate 
system. 


3.3.6.1.9.3.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R071. 


3.3.6.1.9.3.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.3.10.2.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 
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|  Name 

1  Type 

|  Mode  |  Description 

1 

|  Left 

|  Matrices 

1  In  |  First  matrix  to  be  treated  as 

the  minuend 

I  Right 

j  Matrices 

|  In  |  Second  matrix  to  be  treated  as  the  subtrahend! 

3.3.6.1.9.3.10.2.4 

Data  objects: 

The  following  table 

LOCAL  DATA 

describes  the  data  objects  maintained  by 

this  part: 

|  Name  | 

1  Type 

|  Description 

i 

|  Answer 

|  Matrices 

|  Result  of  subtracting  two  input  vectors 

i 

3.3.6.1.9.3.10.2.5 

Not  applicable. 

3.3.6.1.9.3.10.2.6 

PROCESS  CONTROL 

PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  (Left  :  Matrices; 

Right  :  Matrices)  return  Matrices  is 


— declaration  section- 


Ansver  :  Matrices; 


—  — begin  function  (matrices  -  matrices) 


begin 

Answer (X,X)  :-  Left(X,X)  -  Right(X,X); 
Answer(X,Y)  :-  Left(X,Y)  -  Right(X,Y); 
Answer (X,Z)  Left(X,Z)  -  Right(X,Z); 

Answer(Y,X)  :  =  Left(Y,X)  -  Right(Y,X); 
Answer(Y, Y)  :=  Left(Y,Y)  -  Right(Y,Y); 
Answer(Y,Z)  :«  Left(Y,Z)  -  Right(Y,Z); 

Answer(Z,X)  Left(Z,X)  -  Right(Z,X); 
Answer(Z,Y)  :=  Left(Z,Y)  -  Right(Z,Y); 
Answer (Z,Z)  Left(Z,Z)  -  Right(Z,Z); 
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return  Answer; 
end 

3.3.6.1.9.3.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3.3.6.1.9.3.10.2.8  LIMITATIONS 
None. 

3.3.6.1.9.3.10.3  "+"  (MATRICES  +  ELEMENTS)  UNIT  DESIGN  (CATALOG  #P697-0) 

This  unit,  which  is  a  function,  provides  the  capability  to  add  a  scalar  value 
to  each  element  of  a  m  trix.  The  matrix  is  a  3  x  3  matrix  having  9  elements 
which  are  components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian  coordinate 
system. 

3.3.6.1.9.3.10.3.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R060.  . 

3.3.6.1.9.3.10.3.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.6.1.9.3.10.3.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode 

|  Description  | 

|  Matrix 

|  Matrices 

1  In 

|  Matrix  to  be  scaled  | 

|  Addend  | 
1  1 

|  Elements 

1  In 

1 

j  Value  to  be  added  to  each  element  of  the  j 
j  matrix  j 

3.3.6.1.9.3.10.3.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 
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|  Name 

Type 

Description  | 

|  Answer 

Matrices 

Scaled  matrix  | 

3.3.6.1.9.3.10.3.5  PROCESS  CONTROL 
Not  applicable. 

3.3.6.1.9.3.10.3.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  "+"  (Matrix  :  Matrices; 

Addend  :  Elements)  return  Matrices  is 

— declaration  section- 


Ansver  :  Matrices; 


- begin  function  "+"  (matrices  +  elements) 


begin 


Answer(X,X)  :> 
Answer (X,Y)  :■ 
Answer (X,Z)  :< 

Answer(Y,X) 
Ans. er(Y,Y) 
Ansver(Y, Z) 

Answer(Z,X) 
Answer (Z,Y) 
Answer (Z,Z) 


return  Answer; 
end  "+"; 


Matrix(X,X)  +  Addend; 
Matrix(X,Y)  -i-  Addend; 
Matrix(X,Z)  +  Addend; 

Matrix(Y,X)  +  Addend; 
Matrix(Y,Y)  +  Addend; 
Matrix(Y,Z)  +  Addend; 

Matrix(Z,X)  +  Addend; 
Matrix(Z,Y)  +  Addend; 
Matrix(Z,Z)  +  Addend; 


3.3.6.1.9.3.10.3.7  UTILIZATION  OF  OTHER  ELEMENTS 


None. 


CAMP  Software  Detailed  Design  Document 


Page  666 


3.3.6.1.9.3.10.3.8  LIMITATIONS 


None. 


3.3.6.1.9.3.10.4  (MATRICES  -  ELEMENTS)  UNIT  DESIGN  (CATALOG  #?698-0) 

This  unit,  which  is  a  function,  provides  the  capability  to  subtract  a  scalar 
value  from  each  element  of  a  matrix.  The  matrix  is  a  3  x  3  matrix  having  9 
elements  which  are  components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian 
coordinate  system. 


3.3.6.1.9.3.10.4.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R067. 


3.3.6.1.9.3.10.4.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.3.10.4.3  INPUT/OUTPUT 
FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode 

|  Description  | 

|  Matrix  | 

|  Matrices 

|  In 

|  Matrix  to  be  scaled  | 

j  Subtrahend 

|  Elements 

1 

In 

j  Value  to  be  subtracted  from  each  element  j 
j  in  the  matrix  | 

3.3.6.1.9.3.10.4.4  LOCAL  DATA 
Data  objects: 

The  rolloving  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type 

|  Description  | 

|  Answer 

Matrices 

|  Scaled  matrix  as  calculated  by  this  part  | 

3.3.6.1.9.3.10.4.5  PROCESS  CONTROL 
Not  applicable. 
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3.3.6.1.9.3.10.4.6  PROCESSING 


The  following  describes  the  processing  performed  by  this  part: 

function  (Matrix  :  Matrices; 

Subtrahend  :  Elements)  return  Matrices  is 


— declaration  section- 


Answer  :  Matrices; 


—  — function  body- 


begin 

Answer (X,X) 
Answer (X, Y) 
Answer (X, Z) 

Answer (Y,X) 
Answer (Y,Y) 
Answer (Y,Z) 

Answer (Z,X) 
Answer(Z, Y) 
Answer (Z, Z) 


Matrix(X,X) 
:«  Matrix(X,Y) 
:■  Matrix(X,Z) 

Matrlx(Y,X) 

Matrix(Y,Y) 

Matrlx(Y.Z) 

Matrix(Z,X) 
Matrix(Z, Y) 
s-  Matrix(Z,Z) 


-  Subtrahend; 

-  Subtrahend; 

-  Subtrahend; 

-  Subtrahend; 

-  Subtrahend; 

-  Subtrahend; 

-  Subtrahend; 

-  Subtrahend; 

-  Subtrahend; 


return  Answer; 
end 


3.3.6.1.9.3.10.4.7  UTILIZATION  OF  OTHER  ELEMENTS 


None. 


3.3.6.1.9.3.10.4.8  LIMITATIONS 


None. 


3.3.6.1.9.3.10.5  SET  TO  IDENTITY  MATRIX  UNIT  DESIGN  (CATALOG  #P62-0) 

This  part,  which  is  a  function,  provides  the  capability  to  initialize  a  matrix 
to  an  identity  matrix.  The  matrix  shall  be  a  3  x  3  matrix  with  9  elements 
which  are  components  of  the  x-,  y-,  and  z-axes  of  the  Cartesian  coordinate 
system. 
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3.3.6.1.9.3.10.5.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R072. 

3.3.6.1.9.3.10.5.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.6.1.9.3.10.5.3  INPUT/OUTPUT 
None. 

3.3.6.1.9.3.10.5.4  LOCAL  DATA 
None. 

3.3.6.1.9.3.10.5.5  PROCESS  CONTROL 
Not  applicable. 

3.3.6.1.9.3.10.5.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  ( Coord i na t e_Vec t o r_Ma t r  1  x_Algeb r a . Ha t r i x_0pe r a t i ons ) 
function  Set_to_Identity_Matrix  return  Matrices  is 

begin 

return  Identity_Matrix; 
end  Set_to_Identity_Matrix; 

3.3.6.1.9.3.10.5.7  UTILIZATION  OP  OTHER  ELEMENTS 
None. 

3.3.6.1.9.3.10.5.8  LIMITATIONS 
None. 


3.3.6.1.9.3.10.6  SET  TO  ZERO  MATRIX  UNIT  DESIGN  (CATALOG  #P63-0) 

This  unit,  which  is  a  function,  provides  the  capability  to  initialize  each 
element  of  a  matrix  to  zero.  The  matrix  is  a  3  x  3  matrix  having  9  elements 
which  are  components  of  the  x-,  y-,  and  z-axes  of  the  Cartesian  coordinate 
system. 


r*» 
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>> 

3.3.6.1.9.3.10.6.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R078. 

3.3.6.1.9.3.10.6.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.6.1.9.3.10.6.3  INPUT/OUTPUT 
None. 

3.3.6.1.9.3.10.6.4  LOCAL  DATA 
None. 

3.3.6.1.9.3.10.6.5  PROCESS  CONTROL 
Not  applicable. 

3.3.6.1.9.3.10.6.6  PROCESSING 

Sr 

”  The  folloving  describes  the  processing  performed  by  this  part: 

separate  (Coordinate_Vector_Matrix_Algebra.Matrix_Operations) 
function  Set_to_Zero_Matrix  return  Matrices  is 

begin 

return  Zero_Matrix; 
end  Set_to_Zero_Matrix; 

3.3.6.1.9.3.10.6.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3.3.6.1.9.3.10.6.8  LIMITATIONS 
None. 

3. 3. 6. 1.9. 4  MATRIX  SCALAR  OPERATIONS  PACKAGE  DESIGN  (CATALOG  #P66-0) 

This  LLCSC,  which  is  a  package  body,  provides  the  functions  to  allow 
multiplication  or  division  of  each  element  of  a  matrix  by  a  scalar. 

$ 


The  decomposition  for  this  part  is  the  same  as  that  shown  in  the  Top-Level 
Design  Document. 
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3. 3. 6. 1.9. 4.1  REQUIREMENTS  ALLOCATION 

The  following  chart  summarizes  the  allocation  of  requirements  to  this  part: 


|  Name 

|  Requirement  Allocation  | 

|  "*« 

|  R056  | 

|  "/" 

|  R057  | 

3.3.6. 1.9. 4. 2  LOCAL  ENTITIES  DESIGN 
None. 


3.3.6. 1.9. 4. 3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Previously  described  in  package  specification. 


3. 3. 6. 1.9. 4. 4  LOCAL  DATA 


Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name  |  Type  |  Description 


x 

y 

z 


constant  Axes 
constant  Axes 
constant  Axes 


Used  to  index  first  element  in  matrix  row  and/or 
column 

Used  to  index  second  eler.«jnt  in  matrix  row  and/or 
column 

Used  to  index  last  element  in  matrix  row  and/or 
column 


3. 3. 6. 1.9. 4. 5  PROCESS  CONTROL 
Not  applicable. 


3.3.6. 1.9. 4. 6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Coordinate_Vector_Matrix_Algebra) 
package  body  Matrix_Scalar_Operations  is 


—  — declaration  section- 
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X  :  constant  Axes  :=  Axes' FIRST; 

Y  :  constant  Axes  :=  Axes' SUCC(X) ; 
Z  :  constant  Axes  :=  Axes' LAST; 

end  Matrix  Scalar  Operations; 


3. 3. 6. 1.9. 4. 7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 


3.3.6. 1.9. 4. 8  LIMITATIONS 
None. 


3. 3. 6. 1.9. 4. 9  LLCSC  DESIGN 


None. 


3.3.6.1.9.4.10  UNIT  DESIGN 

3.3.6.1.9.4.10.1  UNIT  DESIGN  (CATALOG  #P701-0) 

This  unit,  which  is  a  function,  provides  the  capability  of  multiplying  each 
element  of  a  matrix  by  a  scalar.  The  matrix  is  a  3  x  3  matrix  having  9 
elements  which  are  components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian 
coordinate  system. 


3.3.6.1.9.4.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R056. 


3.3.6.1.9.4.10.1.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.4.10.1.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

The  following  tab1''  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode 

|  Description  | 

|  Matrix 

|  Matricesl 

1  In 

Matrix  to  be  scaled 

j  Multiplier 

|  Scalars 

1  In 

Value  used  to  multiply  each  element  of 

1 

1 

1 

the  matrix 
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3.3.6.1.9.4.10.1.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

Type 

Value 

|  Description  | 

|  Answer 

Matrices2 

N/A 

|  Scaled  matrix  as  calculated  by  this  part  | 

3.3.6.1.9.4.10.1.5  PROCESS  CONTROL 
Not  applicable. 


3.3.6.1.9.4.10.1.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  (Matrix  :  Matricesl; 

Multiplier  :  Scalars)  return  Matrices2  is 


— declaration  section- 


Ansver  :  Matrices2; 


—  — begin  function 


begin 

Answer(X,X) 
Answer (X,Y) 
Answer (X,Z) 
Answer (Y,X) 
Answer (Y,Y) 
Answer (Y,Z) 
Answer(Z,X) 
Answer(Z,Y) 
Answer(Z,Z) 


Matrix(X,X)  * 
Matrix(X, Y)  * 
Matrix(X,Z)  * 
Matrix(Y,X)  * 
Matrix(Y,Y)  * 
Matrix(Y,Z)  * 
Matrix(Z,X)  * 
Matrix(Z,Y)  * 
Matrix(Z,Z)  * 


Multiplier; 

Multiplier; 

Multiplier; 

Multiplier; 

Multiplier; 

Multiplier; 

Multiplier; 

Multiplier; 

Multiplier; 


return  Answer; 


end 


3.3.6.1.9.4.10.1.7  UTILIZATION  OF  OTHER  ELEMENTS 


None. 
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3.3.6.1.9.4.10.1.8  LIMITATIONS 


None. 


3.3.6.1.9.4.10.2  "/"  UNIT  DESIGN  (CATALOG  #P702-0) 

This  unit,  which  is  a  function,  provides  the  capability  of  dividing  each 
element  of  a  matrix  by  a  scalar.  The  matrix  is  a  3  x  3  matrix  having  9 
elements  which  are  components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian 
coordinate  system. 


3.3.6.1.9.4.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R057. 


3.3.6.1.9.4.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.9.4.10.2.3  INPUT/OUTPUT 


FORMAL  PARAMETERS: 

*  The  following  table  describes  this  part's  formal  parameters: 


|  Name 

Type 

|  Mode 

|  Description  | 

|  Matrix 
j  Divisor 

1 

Matrices2 

Scalars 

1  In 

1 

1 

|  Matrix  to  be  scaled  | 

|  Value  used  to  divide  each  element  of  j 
t  the  matrix 

3.3.6.1.9.4.10.2.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name 

1  Type 

j  Description  | 

|  Answer  j 

|  Matricesl 

|  Scaled  matrix  as  calculated  by  this  part  | 

f 


3.3.6.1.9.4.10.2.5  PROCESS  CONTROL 
Not  applicable. 
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3.3.6.1.9.4.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

function  "/"  (Matrix  :  Matrices2; 

Divisor  :  Scalars)  return  Matricesl  is 

— declaration  section- 

Answer  :  Matricesl; 

—  — function  body- 

begin 

Answer(X,X)  :=  Matrix(X,X)  /  Divisor; 

Answer(X,Y)  :=»  Matrix(X,Y)  /  Divisor; 

Answer(X,Z)  :»  Matrix(X,Z)  /  Divisor; 

Ansver(Y,X)  :■  Matrix(Y,X)  /  Divisor; 

Ansver(Y,Y)  :■  Matrix(Y,Y)  /  Divisor; 

Ansver(Y,Z)  :>  Matrix(Y,Z)  /  Divisor; 

Ansver(Z,X)  Matrix(Z,X)  /  Divisor; 

Ansver(Z,Y)  Matrix(Z,Y)  /  Divisor; 

Ansver(Z,Z)  :■  Matrix(Z,Z)  /  Divisor; 

return  Answer; 

end  "/"; 

3.3.6.1.9.4.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 

3.3.6.1.9.4.10.2.8  LIMITATIONS 
None. 

3.3.6.1.10  UNIT  DESIGN 

3.3.6.1.10.1  CROSS  PRODUCT  UNIT  DESIGN  (CATALOG  #P67-0) 

This  LLCSC,  which  is  a  function,  provides  the  capability  of  calculating  the 
cross  product  of  two  vectors.  Each  vector  has  three  elements  vhich  are 
components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian  coordinate  system. 
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3.3.6.1.10.1.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R053. 

3.3.6.1.10.1.2  LOCAL  ENTITIES  DESIGN 
None. 

3.3.6.1.10.1.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Previously  described  in  package  specification. 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 
The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type 

|  Mode 

|  Description  | 

Left 

|  Left  Vectors 

N/A 

Matrix  to  be  used  on  the  left  side  of 

1 

the  cross-product  operation 

Right 

|  Right  Vectors  | 

N/A  | 

Matrix  to  be  used  on  the  right  side  of 

1  1 

the  cross-product  operation 

3.3.6.1.10.1.4  LOCAL  DATA 


Data  objects: 

* 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name  |  Type 


j  Description 


x 

y 

z 

Answer 


constant  Axes 
constant  Axes 
constant  Axes 
Result  Vectors 


Used  to  index  first  element  in  vector 
Used  to  index  second  element  in  vector 
Used  to  index  last  element  in  vector 
Vector  resulting  from  cross  product 
operation  on  two  input  vectors 


3.3.6.1.10.1.5  PROCESS  CONTROL 
Not  applicable. 


CAMP  Software  Detailed  Design  Document 


Page  676 


3.3.6.1.10.1.6  PROCESSING 

The  following  describes  tne  processing  performed  by  this  part: 

separate  (Coordinate_Vector_Matrix  Algebra) 
function  Cross_Product  (Lef!  :  LeIt_Vectors; 

Right  :  Right_Vectors)  return  Result_Vectors  is 


—  — declaration  section- 


X  :  constant  Axes  Axfs'FIRST; 

Y  :  constant  Axes  :»  Axes' SUCC(X) ; 

Z  :  constant  Axes  Axes 'LAST; 

Answer  :  Result  Vectors; 


— begin  function  Cross_Product 


begin 


Ansver(X)  :*  Left(Y)  *  Right(Z) 
Answer(Y)  :•  Left(Z)  *  Right(X) 
Answer (Z)  :■  Left(X)  *  Right (Y) 


Left(Z)  *  Right(Y); 
Left(X)  *  Right(Z); 
Left(I)  *  Right(X); 


return  Answer; 


end  Cross  Product; 


3.3.6.1.10.1.7  UTILIZATION  OP  OTHER  ELEMENTS 
None. 


3.3.6.1.10.1.8  LIMITATIONS 


None. 


3.3.6.1.10.2  MATRIX  VECTOR  MULTIPLY  UNIT  DESIGN  (CATALOG  #P68-0) 

This  LLCSC,  which  is  a  function,  provides  the  capability  to  multiply  a  matrix 
by  a  vector  with  the  result  being  a  vector.  The  matrix  is  a  3  x  3  matrix 
having  9  elements.  The  vectors  have  3  elements.  The  elements  are  components 
in  the  x-,  y-,  and  z-axes  of  a  Cartesian  coordinate  system. 


3.3.6.1.10.2.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R049. 
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3.3.6.1.10.2.2  LOCAL  ENTITIES  DESIGN 


None. 


3.3.6.1.10.2.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Previously  described  in  package  specification. 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

1  Type  | 

Mode 

|  Description 

1 

|  Matrix 

Matrices 

In 

|  Matrix  to  be 

used 

in 

calculations  | 

j  Vector  | 

Input  Vectors! 

In 

j  Vector  to  be 

used 

in 

calculations  j 

3.3.6.1.10.2.4  LOCAL  DATA 
Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 


|  Name  |  Type 


Description 


x 


constant  Axes 


y 


constant  Axes 


z  |  constant  Axes 

I 

Answer  |  Output_Vectors 


Used  to  index  first  row/column  in  matrix 
and  first  element  in  vectors 
Used  to  index  second  row/column  in  matrix 
and  second  element  in  vectors 
Used  to  index  last  row/column  in  matrix 
and  last  element  in  vectors 
Vector  resulting  from  multiplication 
operation 


3.3.6.1.10.2.5  PROCESS  CONTROL 
Not  applicable. 


3.3.6.1.10.2.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Coordinate_Vector  Matrix_Algebra) 
function  Matrix_Vector_MultIply 
(Matrix  :  Matrices; 

Vector  :  Input_Vectors)  return  0utput_Vectors  is 
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i 


—  — declaration  section- 


X  :  constant  Axes  :  =  Axes 'FIRST; 

Y  :  constant  Axes  :=  Axes'SUCC(X) ; 
Z  :  constant  Axes  :=  Axes 'LAST; 

Answer  :  Output_Vectors; 


— begin  function  Matrix_Vector_Multiply 


begin 

Answer(X)  :=•  Matrix(X,X)  *  Vector(X)  + 
Matrix(X,Y)  *  Vector(Y)  + 
Matrix(X,Z)  *  Vector(Z); 

Answer(Y)  :■  Matrix(Y,X)  *  Vector(X)  + 
Matrix(Y,Y)  *  Vector(Y)  + 
Matrix(Y.Z)  *  Vector(Z); 

Ansver(Z)  :■  Matrix(Z,X)  *  Vector(X)  + 
Matrix(Z.Y)  *  Vector(Y)  ♦ 
Matrix(Z,Z)  *  Vector(Z); 

return  Answer; 
end  Matrix  Vector_Multiply; 


3.3.6.1.10.2.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 


3  3.6.1.10.2.8  LIMITATIONS 
None. 


3.3.6.1.10.3  MATRIX  MATRIX  MULTIPLY  UNIT  DESIGN  (CATALOG  #P69-0) 

This  LLCSC ,  which  is  a  function,  provides  the  capability  to  multiply  two 
matrices.  Both  matrices  are  a  3  x  3  matrix  having  9  elements  which  are 
components  in  the  x-,  y-,  and  z-axes  of  a  Cartesian  coordinate  system. 


3.3.6.1.10.3.1  REQUIREMENTS  ALLOCATION 
This  part  meets  CAMP  requirement  R068. 

i 


CAMP  Software  Detailed  Design  Document 


Page  679 


3.3.6.1.10.3.2  LOCAL  ENTITIES  DESIGN 
None. 


3.3.6.1.10.3.3  INPUT/OUTPUT 
GENERIC  PARAMETERS: 

Previously  described  in  package  specification. 

FORMAL  PARAMETERS: 

The  following  table  describes  this  part's  formal  parameters: 


|  Name 

Type 

|  Mode 

|  Description  | 

|  Matrixl 

Left  Matrices 

In 

|  First  matrix  used  for  multiplication 

j  operation 

|  Matrix2 

1 

Right_Matrices 

In 

|  Second  matrix  used  for  multiplication  j 
[  operation  j 

3.3.6.1.10.3.4  LOCAL  DATA 

Data  objects: 

The  following  table  describes  the  data  objects  maintained  by  this  part: 

|  Name 

1 

Type 

1 

Description  | 

X 

1 

1 

constant  Axes 

1 

1 

Used  to  index  first  element  in  matrix  rov  and/or 
column 

y 

1 

1 

constant  Axes 

1 

Used  to  index  second  element  in  matrix  rov 
and/or  column 

z 

1 

constant  Axes 

1 

1 

Used  to  index  last  element  in  matrix  rov  and/or 
column 

Ansver 

1 

1 

Result_Matrices 

1 

Matrix  resulting  from  multiplying  two  input 
matrices 

3.3.6.1.10.3.5  PROCESS  CONTROL 


Not  applicable. 


3.3.6.1.10.3.6  PROCESSING 

The  following  describes  the  processing  performed  by  this  part: 

separate  (Coordinate  Vector  Matrix_Algebra) 
function  Matrix_MatrIx  Multiply 

(Matrixl  :  left  Matrices; 


N"!X 
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Matrix2  :  Right_Matrices)  return  Result_Matrices  is 


—  — declaration  section- 


:  constant  Axes  :=  Axes 'FIRST; 

:  constant  Axes  Axes'SUCC(X); 

:  constant  Axes  :  =  Axes 'LAST; 

answer  :  Result  Matrices; 


—  — function  body- 


begin 

— first  row 

answer (X,X)  Matrixl(X,X)  *  Matrix2(X,X)  + 

Matrixl(X,Y)  *  Matrix2(Y,X)  + 
Matrixl(X,Z)  *  Matrix2(Z,X) ; 

ansver(X,Y)  s-  Matrixl(X,X)  *  Matrix2(X,Y)  + 
Matrixl(X,Y)  *  Matrix2(Y,Y)  + 
Matrixl(X.Z)  *  Matrix2(Z, Y) ; 

answer (X,Z)  Matrixl(X,X)  *  Matrix2(X,Z)  + 

Matrixl(X,Y)  *  Matrix2(Y,Z)  + 
Matrixl(X,Z)  *  Matrix2(Z,Z) ; 

— second  row 

answer(Y,X)  :=»  Matrixl(Y,X)  *  Matrix2(X,X)  + 
Matrixl(Y, Y)  *  Matrix2(Y,X)  + 
Matrixl(Y,Z)  *  Matrix2(Z,X) ; 

ansver(Y,Y)  :■  Matrixl(Y,X)  *  Matrix2(X,Y)  + 
Matrixl(Y,Y)  *  Matrix2(Y,Y)  + 
Matrixl(Y,Z)  *  Matrix2(Z,Y) ; 

answer(Y,Z)  :«  Matrixl(Y,X)  *  Matrix2(X,Z)  + 
Matrixl(Y,Y)  *  Matrix2(Y,Z)  + 
Matrixl(Y,Z)  *  Matrix2(Z,Z); 

— third  row 

answer(Z,X)  :=  Matrixl(Z,X)  *  Matrix2(X,X)  + 
Matrixl(Z,Y)  *  Matrix2(Y,X)  + 
Matrixl(Z,Z)  *  Matrix2(Z,X) ; 

answer(Z,Y)  :■  Matrixl(Z,X)  *  Matri.x2(X,Y)  + 
Matrixl(Z, Y)  *  Matrix2(Y,Y)  + 
Matrixl(Z,Z)  *  Matrix2(Z,Y) ; 


answer(Z,Z)  Matrixl(Z,X)  *  Matrix2(X,Z)  + 
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Matrixl(Z,Y)  *  Matrix2(Y,Z)  + 
Matrixl(Z,Z)  *  Matrix2(Z, Z) ; 


return  answer; 
end  Matrix_Matrix_Multiply; 

3.3.6.1.10.3.7  UTILIZATION  OF  OTHER  ELEMENTS 
None. 


3.3.6.1.10.3.8 


LIMITATIONS 
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with  General_Purpose_Math; 

package  body  Coordinate_Vector_Matrix_Algebra  is 

package  body  Matrix_Operations  is  separate; 

package  body  Matrix_Scalar_Operations  is  separate; 

function  CrossProduct  (Left  :  Lef t_Vectors; 

Right  :  Right_Vectors) 
return  Result_Vectors  is  separate; 

function  Matrix_Vector_Multiply  (Matrix  :  Matrices; 

Vector  :  Input_Vectors) 
return  Output_Vectors  is  separate; 

function  Matrix_Matrix_Multiply  (Matrixl  :  Lef t_Matrices; 

Matrix2  :  Right_Mat rices) 
return  Result_Matrices  is  separate; 

pragna  PAGE; 

package  body  Vector  Operations  is 


—  declaration  section 


X 

Y 

Z 


:  constant  Axes 
:  constant  Axes 
:  constant  Axes 


:«  Axes 'FIRST; 

Axes' SUCC(X); 
:«  Axes' LAST; 


Zero  Vector  :  constant  Vectors 


(others  ■>  0.0); 


—  local  Junctions- 


function  Rsos  is  nev 

General  Pur pose_Ma th .  Roo t_Sum_0f _Squares 
(ReaI_Type  ->  Elements, 

Squared  Type  ->  Elements  Squared, 

~  _>  »*«, 

Sqrt  »>  Sqrt); 


pragna  PAGE; 

function  "+”  (Left  ;  Vectors; 

Right  :  Vectors)  return  Vectors  is 


—  declaration  section- 


Answer  :  Vectors; 


— fitnction  body- 
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begin 

Answer(X)  :=  Left(X)  +  Right(X); 

Answer(Y)  :=  Left(Y)  +  Right(Y); 

Answer(Z)  :=  Left(Z)  +  Right(Z); 

return  Answer; 

end 

pragma  PAGE; 

function  (Left  :  Vectors; 

Right  :  Vectors)  return  Vectors  is 


—  declaration  section- 


Answer  :  Vectors; 

— function  body- 

begin 

Ansver(X)  s-  Left(X)  -  Right (X); 

Ansver(Y)  :«  Left(Y)  -  Right(Y); 

Answer (Z)  :>  Left(Z)  -  Right(Z); 

return  Ansver; 

end 

pragma  PAGE; 

function  Vector_Length  (Vector  :  Vectors)  return  Elements  is 
begin 

return  Rsos(Vector(X) ,  Vector(Y),  Vector(Z)); 
end  Vector_Length; 
pragma  PAGE; 

function  Dot_Product  (Vectorl  s  Vectors; 

Vector2  :  Vectors)  return  Elements_Squared  is 


—  declaration  section- 


Answer  :  Element s_Squared; 


— Junction  body- 
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begin 

Answer  :=  Vectorl(X)  *  Vector2(X)  + 

Vectorl(Y)  *  Vector2(Y)  + 

Vectorl(Z)  *  Vector2(Z); 

return  Answer; 

end  Dot_Product; 

pragma  PAGE; 

function  Sparse_Right_Z_Add  (Left  :  Vectors; 

Right  :  Vectors)  return  Vectors  is 


—  declaration  section- 


Answer  :  Vectors; 


— Junction  body- 


begin 

Answer(X)  s»  Left(X)  +  Right(X); 
w  Answer(Y)  ;■  Left(Y)  +  Right (Y); 

Ansver(Z)  :*  Left(Z); 

return  Answer; 

end  Sparse_Right_Z_Add; 

pragma  PAGE; 

function  Sparse_Right_X_Add  (Left  :  Vectors; 

Right  :  Vectors)  return  Vectors  is 


—  declaration  section- 


Ansver  :  Vectors; 


— Junction  body- 


begin 

Answer(X)  Left(X); 

Ansver(Y)  :■  Left(Y)  +  Right(Y); 
Answer(Z)  :=  Left(Z)  +  Right(Z)’ 

return  Answer; 

end  Sparse_Right_X_Add; 
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pragma  PAGE; 

function  Sparse_Right_Xy_Subtract  (Left  s  Vectors; 

Right  :  Vectors)  return  Vectors  is 


—  declaration  section 


Answer  :  Vectors; 


— function  body- 


begin 

Answer(X)  :»  Left(X); 

Answer(Y)  :=  Left(Y); 

Answer(Z)  :=  Left(Z)  -  Right(Z); 

return  Answer; 

end  Sparse_Right_Xy_Sub tract; 
pragma  PAGE; 

function  Set_To_Zero_Vector  return  Vectors  ia 
begin 

return  Zero_Vector; 
end  Set_To_Zero_Vector; 
end  Vector_Operations; 
pragma  PAGE; 

package  body  Vector_Scalar_Operations  is 


—  declaration  section- 


X  :  constant  Axes  : -  Axes 'FIRST; 

Y  :  constant  Axes  Axes' SUCC(X) ; 

Z  :  constant  Axes  : -  Axes 'LAST; 

pragma  PAGE; 

function  (Vector  :  Vectorsl; 

Multiplier  :  Scalars)  return  Vectors2  is 


—  declaration  section- 


Answer  :  Vectors2; 
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—  begin  function 


begin 

Answer(X)  :=  Vector(X)  *  Multiplier; 

Ansver(Y)  :=  Vector(Y)  *  Multiplier; 

Ansver(Z)  :=  Vector(Z)  *  Multiplier; 

return  Answer; 

end 

pragma  PAGE; 

function  "/"  (Vector  s  Vectors2; 

Divisor  :  Scalars)  return  Vectorsl  is 


—  declaration  section 


Ansver  :  Vectorsl; 


—  begin  Junction  7" 


begin 

Ansver(X)  :■  Vector(X)  /  Divisor; 

Ansver(Y)  Vector(Y)  /  Divisor; 

Ansver(Z)  :■  Vector(Z)  /  Divisor; 

return  Ansver; 

end  V; 

pragma  PAGE; 

function  Sparse_X_Vector_Scalar_Multiply 
(Vector  s  Vectorsl; 

Multiplier  :  Scalars)  return  Vectors2  is 


—  declaration  section- 


•Ansver  s  Vectors2; 


—  begin  function  Sparse _X  Vector  Scalar  Multiply 


begin 

Ansver(X)  0.0; 

Ansver(Y)  :■  Vector(Y)  *  Multiplier; 
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Answer(Z)  :=  Vector(Z)  *  Multiplier; 
return  Answer; 

end  Sparse_X_Vector_Scalar_Multiply ; 
end  Vector_Scalar_Operations; 
end  Coordinate  Vector  Matrix_Algebra; 
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separate  ( Coord inate_Vector_Matrix_Algebra) 
package  body  Matrix_Operations  is 


—  — declaration  section- 


X  :  constant  Axes  :=  Axes 'FIRST; 

Y  :  constant  Axes  :=  Axes' SUCC(X) ; 

Z  :  constant  Axes  Axes ' LAST; 

—  — the  diagonal  elements  of  Identity  Matrix  will  be  set  to  1.0  during 

—  — package  initialization 

Identi ty_Matrix  :  Matrices  t-  (others  ->  (others  ■>  0.0)); 
Zero_Matrix  :  constant  Matrices  (others  «>  (others  ->  0.0)); 


—  —  subroutine  bodies- 


function  Set_To_Identity_Matrix  return  Matrices  is  separate; 
function  Set_To_Zero_Matrix  return  Matrices  is  separate; 
pragma  PAGE; 

function  (Left  :  Matrices; 

Right  :  Matrices)  return  Matrices  is 


—  declaration  section- 


Answer  :  Matrices; 


—  —  begin  function  "+"  (matrices  +  matrices) 


begin 


Ansver(XtX) 
Answer (X, Y) 
Answer(X,Z) 


Lef t(X,X)  +  Right(X,X); 
Lef t(X, Y)  +  Right(X,Y); 
Lef t(X,Z)  +  Right(X,Z) ; 


Answer(Y,X) 

Answer(Y,Y) 

Answer(Y,Z) 


Lef t(Y,X)  +  Right(Y.X); 
Lef t(Y,Y)  +  Right(Y,Y) ; 
Lef t(Y,Z)  +  Right(Y,Z); 


Answer (Z,X) 
Answer(Z,Y) 
Answer (Z,Z) 


Lef t(Z,X)  +  Right(Z,X); 
Lef t(Z,Y)  +  Right(Z,Y) ; 
Lef t(Z,Z)  +  Right(Z,Z) ; 


return  Answer; 


end  "+"; 
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pragma  PAGE; 

function  (Left  :  Matrices; 

Right  :  Matrices)  return  Matrices  is 


—  declaration  section- 


Answer  :  Matrices; 


—  —  begin  Junction  "  ( matrices  -  matrices ) 


begin 


Answer (X,X) 
Answer(X, Y) 
Answer(X,Z) 


Lef t(X,X)  -  Right(X,X) ; 
Lef t(X,Y)  -  Right(X, Y) ; 
Lef t(X,Z)  -  Right(X,Z) ; 


Answer(Y,X) 
Answer (Y, Y) 
Ansver(Y,Z) 


Lef t(Y,X)  -  Right(Y.X); 
Lef t(Y, Y)  -  Right(Y,Y) ; 
Lef t(Y,Z)  -  Right(Y,Z); 


Ansver(Z,X)  Left(Z,X) 
Ansver(Z.Y)  Left(Z,Y) 
Answer(Z,Z)  s-  Left(Z,Z) 


Right(ZfX); 
Right(Z, Y) ; 
Right(Z,Z) ; 


return  Ansver; 
end 


pragma  PAGE; 

function  (Matrix  :  Matrices; 

Addend  :  Elements)  return  Matrices  is 


—  declaration  section 


Ansver  :  Matrices; 


—  —  begin  function  *  +  *  (matrices  +  elements)- 


begin 

Answer(X,X)  5-  Matrix(X,X)  +  Addend; 
Answer(X,Y)  :■  Matrix(X,Y)  +  Addend; 
Answer(X,Z)  Matrix(X,Z)  +  Addend; 

Ansver(Y,X)  s-  Matrix(Y,X)  +  Addend; 
Ansver(Y,Y)  s-  Matrix(Y,Y)  +  Addend; 
Ansver(Y,Z)  :■  Matrix(Y,Z)  +  Addend; 

Ansver(Z,X)  Matrix(Z,X)  +  Addend; 
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Answer(Z,Y)  Matrix(Z,Y)  +  Addend; 

Answer(Z,Z)  :=  Matrix(Z,Z)  +  Addend; 

return  Answer; 

end  "+"; 

pragma  PAGE; 

function  (Matrix  :  Matrices; 

Subtrahend  :  Elements)  return  Matrices  is 


—  declaration  section- 


Answer  :  Matrices; 


—  —  function  body 


begin 


Answer(XfX)  Matrix(X,X) 
Answer (X,Y)  Matrix(X,Y) 
Answer (X,Z)  Matrix(X,Z) 


Subtrahend; 

Subtrahend; 

Subtrahend; 


Answer(Y,X) 
Answer (Y,Y) 
Answer(Y,Z) 


Matrix(Y,X) 
s-  Matrix(Y,Y) 
Matrix(Y,Z) 


-  Subtrahend; 

-  Subtrahend; 

-  Subtrahend; 


Answer(Z,X) 

Answer(Z,Y) 

Answer(Z,Z) 


Matrix(Z,X)  -  Subtrahend; 
Matrix(Z,Y)  -  Subtrahend; 
Matrix(ZfZ)  -  Subtrahend; 


return  Answer; 


end 


pragma  PAGE; 


—  begin  package  Matrix  Operations- 


begin 

—  —  initialize  diagonal  elements  of  Identity  Matrix,  remaining  elements  have 

—  — already  been  set  to  0.0 

Identity_Matrix(Xf X)  s*  1.0; 

Identity_Matrix(Y,Y)  :=  1.0; 

Identity_Matrix(Z,Z)  1.0; 

end  Matrix  Operations; 


CAMP  Software  Detailed  Design  Document 


Page  692 


separate  (Coordinate_Vector_Matrix_Algebra.Matrix_Operations) 
function  Set_To_Identity_Matrix  return  Matrices  is 

begin 

return  Identity_Matrix; 
end  Set_To_Identity_Matrix; 
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separate  ( Coord inate_Vector_Matrix_Algebra.Matrix_Operat ions) 
function  Set_To_Zero_Matrix  return  Matrices  is 

begin 

return  Zero_Matrix; 
end  Set  To  Zero  Matrix; 
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separate  (Coordinate_Vector_Matrix_Algebra) 
package  body  Matrix_Scalar_Operations  is 


—  — declaration  seciion- 


X  :  constant  Axes  Axes 'FIRST; 

Y  :  constant  Axes  is  Axes' SUCC(X) ; 

Z  :  constant  Axes  :*  Axes 'LAST; 

pragaa  PAGE; 

function  (Matrix  :  Matricesl; 

Multiplier  :  Scalars)  return  Matrices2  is 


—  declaration  section- 


Ansver  :  Matrices2; 


—  — begin  Junction 


begin 

Answer(X,X) 
Answer (X,Y) 
Answer (X,Z) 
Answer(Y,X) 
Answer(Y,Y) 
Answer (Y,Z) 
Answer (Z,X) 
Answer(Z, Y) 
Answer(Z,Z) 


Matrix(X,X) 

Matrix(XfY) 

Matrix(X,Z) 

Matrix(Y,X) 

Matrix(Y,Y) 

Matrix(Y,Z) 

Matrix(Z,X) 

Matrix(Z,Y) 

Matrix(Z,Z) 


*  Multiplier; 

*  Multiplier; 

*  Multiplier; 

*  Multiplier; 

*  Multiplier; 

*  Multiplier; 

*  Multiplier; 

*  Multiplier; 

*  Multiplier; 


return  Answer; 


end 


pragaa  PAGE; 

function  "/"  (Matrix  :  Matrices2; 

Divisor  :  Scalars)  return  Matricesl  is 


—  declaration  section- 


Answer  :  Matricesl; 


—  —  function  body- 


begin 
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Answer(X,X) 
Answer(X, Y) 
Answer (X,Z) 

Answer(Y,X) 
Answer (Y, Y) 
Answer (Y,Z) 

Answer (Z,X) 
Answer (Z, Y) 
Answer(Z,Z) 

return  A — w 

end 


:=  Matrix(X,X) 
:=  Matrix(X,Y) 
:■  Matrix(X,Z) 

:=  Matrix(Y,X) 
Matrix(Y,Y) 
Matrix(Y,Z) 

:»  Matrix(Z,X) 
Matrix(Z,Y) 
Matrix(Z,Z) 


end  Matrix_Scalar_Operations; 


Divisor; 

Divisor; 

Divisor; 

Divisor; 

Divisor; 

Divisor; 

Divisor; 

Divisor; 

Divisor; 
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separate  (Coordinate_Vector_Matrix  Algebra) 
function  Cross_Product  (LefI  :  LeIt_Vectors; 

Right  :  Right_Vectors)  return  Result_Vectors  is 


—  —  declaration  section¬ 


'll  :  constant  Axes  :*  Axes' FIRST; 

Y  :  constant  Axes  :■  Axes' SUCC(X) ; 

Z  :  constant  Axes  : -  Axes 'LAST; 

Answer  :  Result  Vectors; 


—  begin  function  Cross  Product 


begin 

Answer (X)  :=  Left(Y)  *  Right(Z)  -  Left(Z)  *  r  ght(Y); 

Answer(Y)  Left(Z)  *  Right(X)  -  Left(X)  *  Right(Z); 

Answer(Z)  s-  Left(X)  *  Right(Y)  -  Left(Y)  *  Right(X); 

return  Ansver; 

end  Cross  Product; 
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separate  (Coordinate_Vector  Matrix  Algebra) 
function  Matrix_Vector_MultIply 
(Matrix  :  Matrices; 

Vector  :  Input_Vectors)  return  Output_Vectors  is 


—  —  declaration  section- 


X  :  constant  Axes  :  =  Axes 'FIRST; 

Y  :  constant  Axes  :  =  Axes' SUCC(X) ; 
Z  :  constant  Axes  :>  Axes' LAST; 

Answer  :  Output_Vectors; 


—  begin  function  Matrix  Vector  Multiply 


begin 


Ansver(X)  :*  Matrix(X,X)  *  Vector(X)  + 
Matrix(X, Y)  *  Vector(Y)  + 
Matrix(X,Z)  *  Vector(Z); 


Ansver(Y)  s 


Ansver(Z)  : 


-  Matrix(Y,X) 
'  Matrix(Y,Y) 

Matrix(Y,Z) 

-  Matrix(Z,X) 
Matrix(Z.Y) 
Matrix(Z.Z) 


*  Vector(X)  + 

*  Vector(Y)  + 

*  Vector(Z); 

*  Vector(X)  + 

*  Vector(Y)  + 

*  Vector(Z); 


return  Answer; 


end  Matrix_Vector_Multiply; 
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function  Matrix_MatrIx_MultIply 

(Matrixl  :  Lef t_Matrices; 

Matrix2  :  Right_Matrices)  return  Result  Matrices  is 


—  —  declaration  section- 


X  :  constant  Axes  :  =  Axes' FIRST; 

Y  :  constant  Axes  Axes' SUCC(X) ; 

Z  :  constant  Axes  : «  Axes 'LAST; 

Answer  :  Result  Matrices; 


—  — Junction  body- 


begin 


— first  row 


Ansver(X,X)  Matrixl(X,X)  *  Matrix2(X,X)  + 
Matrixl(X,Y)  *  Matrix2(Y,X)  + 
Matrixl(X,Z)  *  Matrix2(Z,X); 


Answer(X,Y)  Matrixl(X,X)  *  Matrix2(X,Y)  + 
Matrixl(X.Y)  *  Matrix2(Y,Y)  + 
Matrixl(X,Z)  *  Matrix2(Z,Y) ; 

Answer(X,Z)  s-  Matrixl(X,X)  *  Matrix2(X,Z)  + 
Matrixl(X, Y)  *  Matrix2(Y,Z)  + 
Matrixl(X,Z)  *  Matrix2(Z,Z) ; 

—  second  row 


Answer (Y,X)  Matrixl(Y,X)  *  Matrix2(X,X)  + 

Matrixl(Y, Y)  *  Matrix2(Y,X)  + 
Matrixl(Y,Z)  *  Matrix2(Z,X) ; 

Ansver(Y.Y)  Matrixl(YfX)  *  Matrix2(X,Y)  + 

Matrixl(Y,Y)  *  Matrix2(Y,Y)  + 
Matrixl(Y,Z)  *  Matrix2(Z,Y); 

Answer (Y,Z)  Matrixl(Y,X)  *  Matrix2(X,Z)  + 

Matrixl(Y,Y)  *  Matrix2(Y,Z)  + 
•Matrixl(Y,Z)  *  Matrix2(Z,Z) ; 

—  third  row 


Answer(Z,X)  :»  Matrixl(Z,X)  *  Matrix2(X,X)  + 
Matrixl(Z, Y)  *  Matrix2(Y,X)  + 
Matrixl(Z,Z)  *  Matrix2(Z,X) ; 

Answer(Z,Y)  Matrixl(Z,X)  *  Matrix2(X,Y)  + 
Matrixl(Z, Y)  *  Matrix2(Y,Y)  + 
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Answer(Z,Z)  : 


return  Answer; 


Matrixl(Z,Z) 

=  Matrixl(Z,X) 
Matrixl(Z, Y) 
Matrixl(Z.Z) 


Matrix2(Z,Y) ; 

Matrix2(X,Z) 
Matrix2(Y,Z) 
Matrix2(Z,Z) ; 


end  Matrix_Matrix_Multiply; 
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